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FOREWORD 


This report presents the results of a nlne--moath study by Martin Mari- 
etta for the National Aeronautics and Space Aimlnistration's George C* 
Marshall Spaceflight Center. This study, including conceptual design 
and simulation of three video guidance systems for spacecraft, was per- 
formed under contract NAS8-34679, Development of an Autonomous Video 
Rendezvous and Docking System. Significant benefits were obtained from 
previous related work under Martin Marietta IR&D task D-llR. 
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SUMMARY 


A simple docking aid consisting of three flashing lights has proved 
viable for use in an autonomous video rendezvous and docking system for 
spacecraft. A television image of this target ran be analyzed to de- 
termine the relative positions and attitudes of the two spacecraft* 

The analysis time is only 100 milliseconds because a simple dedicated 
electronic circuit assists in the analysis. 

Control systems using this and two other types of docking aids were 
evaluated through computer simulation in this study and other approach- 
es were considered. However, this three-light system performed much 
better than tne others. Its accuracy is affected little by tumbling of 
the tai-get spacecraft, and in the simulations it was able to cope with 
attitude rates up to 20,000 degrees per hour ^ about the docking axis. 
Its performance with rotation about other axes is determined primarily 
by the state-estimation and goal-setting portions cT the control sys- 
tem, not by measurement accuracy. 

A physical simulation of the three-light control system would be useful 
to verify the validity of the assumptions and mathematical models used 
in this study. The simulation should employ scaled target models, a 
television camera, and hardware video signal processing electronics. 

The simulation should also model the spacecraft control system and the 
limitations of a practical spacecraft. This level of detail is recom- 
mended to force consideration of compatibility problems and may reveal 
weaknesses in the approach that might not otherwise be detected. This 
report includes a discussion of a suitable control system, and Appendix 
A discusses a computer program that can serve as the basis for the 
physical simulation. 
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II. Introduction 
to the Problem 



II. 


INTRODUCTION TO THE PROBLEM 


The need for an Automated Rendezvous and Docking System has been shown 
in a number of mission models, including those in the Mars sample re- 
turn and large space system studies. Several factors make automation 
attractive: practical limitations on human interaction, fuel-use and 

trajectory optimization requirements, safety, communication limita- 
tions, and the m.ed for real-time operation. 

The purpose of this study was to identify video techniques that might 
be suitable for such an automated system, define the equations and al- 
gorithms these techniques would use, and evaluate video guidance con- 
trol systems based on these techniques through computer simulation- 

To ensure that practical problems were considered, the simulation was 
to model not only the sensor but also methods for dealing with a number 
of practical problems, e.g., maintaining control when the target space- 
craft leaves the field of view of the guidance sensor. The simulation 
also was to model the characteristics and limitations of practical 
spacecraft, because this may reveal subtle Incompatibilities. Amis- 
sion model was then defined to serve as a basis for the simulation. 

In this model the chase vehicle is a general-purpose spacecraft for 
repair, ref urbishnent , and retrieval of other spacecraft. After it is 
deployed from the Space Shuttle, it must rendezvous and dock with a 
passive target spacecraft that is in a circular orbit about the earth 
at an altitude of 300 km. The chase vehicle is illustrated in Figure 
II-l and has the characteristics summarized in Table II-l. 

The target spacecraft (Fig. II-2), is similar to the Long Duration Ex- 
posure Facility (LDEF). It has an appropriate docking aid and docking 
fixture, but it is passive during the docking operation. It can nei- 
ther perform cooperative maneuvers nor maintain a stable attitude. Its 
only means of cooperation is turning docking-aid lamps on and off in 
response to radio commands. 

Each computer simulation was to begin when the coarse rendezvous sys- 
tem, which Has gotten the chase vehicle to within 1000 feet of the tar- 
get, hands control to the video system. The coarse rendezvous is as- 
sumed accurate enough to guarantee that the target is within the field 
of view of the video guidance sensor. (Initial target acquisition is 
considered in the study but is not modeled in the computer simula- 
tions.) It is also assumed that, although fuel represents a signifi- 
cant fraction of the vehicle’s mass, the mass during the terminal ren- 
dezvous can be predicted with reasonable accuracy. Because fuel use 
can be measured, this assumption is not unreasonable. 

The scope of the study did not include system opti^.ization, trajectory 
planning, or detailed hardware design. 
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The Body Coordinate System Used in the Simulations Are Shown 
Figure II-l Chase Vehicle Modeled for Coinputer Simulations 

Table II-l Chase Vehicle Characteristics 


Vehicle Size; Length ; 5m 
Width: 13m 

Height: 4.5m 

Vehicle Mass: 3700 kg (Full Fuel Tank) 

1800 kg (Empty Fuel Tank) 

Fuel: Monopropellant Hydrazine with GN 2 Blowdown 

2 

Approximate Translational Acceleration Authority (Each Axis): 0.1 m/s * 


2 

Approximate Angular Acceleration Authority (Each Axis): 0.037 rad/s * 

Total Impulse: 4.9 x 10^ N*s* 

2 

Moments of Inertia (kg*m ) : 

Full Fuel Tank Empty Fuel Tank 


Pitch 



* These Characteristles Vary with Fuel Load 
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Fijuj'e 11-2 TaV'j^t Spaoeci'aft ^-SoJeled fov Corrp.utev SinulatijKd 

Trie CooiKiinute SjUter" Uced in t':e dlt-nd-^itioKsS Ij 

llote trie dejative X Axis Is Tkoun: Chase Vehicle ^nd Tu'pi : 

X Axes Are PaiKillel When the Tve Spaaeai'a; t /Ire J'r -ked. 
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III. COl, ELUSIONS AND RECOMMENDATIONS 


A. A THREE-LIGHT DOCKING AID IS RECOMMENDED 


Of the three v^cieo guidance systems simulated in this study, the best 
system used the three-light docking aid shown in Figure III-l. Not 
only was it the simplest of the three systems, it was also the only 
system that worked reliably in the simulations. 

Dockiug Aid 
on Target 
(3 Lights in 




Figure FloBhing^ Light Docking Aid 


It was not accuracy that made this system best; it consistently outper- 
formed the others even though the resolution and target size that were 
simulated gave it the poorest accuracy at long range. Its advantage 
was that it could measure both relative position and relative attitude 
from a single observation. The other systems had to resolve ambigu- 
ities in attitude by combining two successive measurements, an approach 
the simulation results proved to be dangerous. 

The problem with the other two systems could be solved by modifying the 
docking aids slightly. For example, one of these systems used a ring 
of lights on the target spacecraft for a docking aid. By observing the 
target, the guidance system can determine that the camera lies some- 
where on a circle about the docking axis, but it cannot determine the 
camera's position on the circle. The addition of one light (Fig. 

III-2) would greatly improve the performance of the guidance system by 
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uniquely defining the direction to the docking axis. Unfortunately, 
this approach results in a system that is more complicated than the 
three-*light system because the modification requires adding a way of 
distinguishing between the ring of lights and the added light* Fur- 
ther, target roll about the docking axis still cannot be observed with 
this system. 



Ring of 


Figure JjTI-2 Modification to Ring^of ^Lights Docking Aid 
Target Roll about the Docking Axis Is Still Not Observable^ 
hut the Direction to the Docking Axis Is Uniquely Defined. 

The other system simulated used a docking aid that projects a rainbow 
of light in each of two direction"?* Color sensing and stereo range- 
finding are used in this system to uniquely define the chase vehicle’s 
position. Relative attitude, however, is ambiguous because chase ve- 
hicle rotation about the line of sight is not observable* The problem 
could be solved by adding some means for sensing this rotation, but 
this system is already the most complex of the three. 


B* M.\NY FACTORS DETFJIMINE PERFOPMANCE 


The video guidance system must do much more than determine the current 
position and attitude* It must also turn chase vehicle thrusters on 
and off to steer a safe course from the current position to the target 
spacecraft. It must ensure that the chase vehicle arrives at the tar- 
get with the proper attitude and that the two spacecraft contact at low 
velocity. It must also align the chase vehicle’s docking fixture prop- 
erly with the docking fixture on the target spacecraft. In the process 
of doing these things, it must \ >t allow the target’s image to leave 
the field of view of its television camera for more than a moment* 

A control system may perform these furctlons poorly despite accurate 
knowledge of relative position and attitude* In this study we tried to 
uncover subtle incompatibilities between video guidance techniques and 
the remainder of the control system by modeling a complete system* If 
we had not, problems with the *’rainbow*‘ and '*ring-of-llght ‘ approaches 
might have gone undiscovered. The problem in evaluating the systems 
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this way is chat performance depends on the entire system and not Just 
the video guidance technique. If the system as a whole does not make 
effective use of the video information, there is a danger that a poten- 
tially useful technique will be rejected. 

For example, we found that a small change in the goal-setting logic of 
the control system made a great difference in the ability of the 
three-light system to cope with tumbling targets. Suitable changes in 
the other simulations might have made the "rainbow” and ”ring-of- 
lights” approaches look more attractive. 

While we do not believe that such changes would have altered the con- 
clusions of the study (the three-light system is still simplest and 
least sensitive to the rest of the system), we believe that “fine-tun- 
ing” of the control system for best performance is worth the effort. 

We also want to caution the reader that the performance reported here 
is not necessarily the best the system might be able to provide. 


C. THE HARD PART IS THE LAST EIGHT METERS 


A system that measures only the distance and direction to the target is 
adequate to approach within eight meters of the targe . At this point 
attitude information becomes vital because offsets among the docking 
aid, target docking fixture, and target center of mass become major 
contributors to alignment errors. The offsets among the camera, chase 
vehicle center of mass, and chase vehicle docking fixture make attitude 
information doubly important because chase vehicle attitude and posi- 
tion must be controlled. To further complicate the problem, the target 
may be coning and nutating, making it difficult to anticipate attitude 
changes. 

All three systems performed well at great distances from the target, 
and all three had problems at close range. The ring-of-llght s system 
wa^ totally unable to cope with close range because the relative veloc- 
ity between the chase vehicle and target is small at close range. This 
system depends on differences between successive observations to meas- 
ure attitude. With the velocity reduced, it was using observations in 
which the differences were almost entirely due to random effects. 

The “rainbow” system received Its best attitude information at close 
rar^’e because small movements produced greater changes in orientation 
of the line of sight. But during the last few critical seconds of the 
operation. It loses range Information because the rangefinder cameras 
cannot see the docking aid. 

Although the three-light system maintained good accuracy at close 
range, It still had problems. Small translational movements between 
light flashes made it more difficult to keep the entire target within 
the camera’s field of view. Target rotation made the problems more 
severe. Also, because the equations this system uses for image inter- 
pretation are based on orthographic projection, their accuracy became 
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poorer as range decreased: this projection approximates the image's 

appearance well only when the ranf^e is much greater than the distance 
between the lights on the docking aid. 

Some of the close-range problems might be handled by using two differ- 
ent docking aids. A large docking lid could be used at long range, and 
a smaller one with the same geometry could be used for clcse-in opera- 
tions. Even if this is done, close range will remain the most diffi- 
cult problem. 


D. TUMBLING TARGETS MAKE CONTROL DIFFICULT 


Effective operations with tumbling and coning targets will require so- 
phisticated state estimators and goal-setting logic. The normal tixnble 
rate of the target in the mission model for this study is one revolu- 
tion per orbit, or 240 degrees per hour. Although the control system 
used in the simulations was able to cope with roll rates of over 20,000 
degrees per hour about the docking axis, the system had trouble in 
keeping the docking aid within the field of view and in docking with 
the proper alignment with rates as small as 1000 degrees per hour in 
pitch or yaw. At rates of about 4000 degrees per hour in pitch or yaw, 
docking was extremely difficult;. The problem is not measurement accur- 
acy but control. The structure of the control system presented in 
Chapter VIII is adequate for dealing with rotating targets, but the 
simplified version used In the simulations is Inadequate for high tum- 
ble rates. 

Some fundamental constraints must be kept in mind in refining the con- 
trol system. First, the chase vehicle's thrust authority is limited. 

If the control syst^ tries to minimize stresses on the docking fix- 
tures by staying on the docking axi<? at all times, the thrusters may 
not be able to overcome centrifugal force. If the control system tries 
to minimize problems with centrifug*^! force, it can plan a trajectory 
that takes the chase vehicle directly to the point where the target's 
docking fixture is predicted to be on arrival. However, this approach 
may greatly stress docking fixtures of both spacecraft. Further, a 
slight error in estimating tumble parameters may cause the docking fix- 
tures to miss each other. Solving problems like these was beyond the 
scope of the study reported here. We recommend a separate study to in- 
vestigate possible solutions. 


E. A PHYSICAL SIMULATION SHOULD INCLUDE A CONTROL SYSTHM, CAMERA, AND 
TARGET 


By modeling an entire six-degree-of-f reedom control system, this study 
uncovered problems that might have gone unnoticed if only measurements 
had been modeled. We highly recommend the same approach in a physical 
simulation. This will not be difficult to Implement because the com- 
puter programs in Appendices A through C already include ''dummy*' sub- 
routines for control of a physical simulator. 
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The simulator should allow positioning of a television camera anywhere 
in a large room under computer control, and have a gimbal set to allow 
pointing ot the camera. It is not necessary to rotate the target model 
because only relative position and attitude are detectable in the tele- 
vision image* Tumbling of anv complexity can be simulated, and It is 
not necessary to make mechanical changes to switch between simple tun- 
bling about the docking axis and a complex coning and nutating motion* 
However, the simulated rates must be small enough so only one side of 
the target need be visible. 

Simulator ^peed Is entirely a matter of convenience* Although computer 
control will be required to allow simulations to be run in a reasonable 
amount ot time, little is gained by running the simulation in exactly 
the amount of time required for an actual operation in space* Although 
j full-speed operation would show the effects of image smear and after 

; images, impiomonting the system with a solid-state camera and flash 

I l.jmps would make these factors insignificant. 

I 

! To siimilaLt* the full dynamic range of 300 meters to contact, it will 

I probabU be necessary to build two or throe different target models. 

One of those imxiels would be one or two percent of full scale and would 
j simulate the appearance of the target at long range. Another would be 

;i much larger, perhaps full scale, and would show the detail visible at 

I close r.nv\o. IVponding on the dimensions of the room and the accuracy 

Vi of Lhc simuhitor, it may be desirable to use a third model for inter- 

■^1 mediate ranges. 

i 

' The remit ot this study show that a camera with resolution comparable 

to St uKlard television will be suitable. A solid-state camera is at- 
tract ive ler space because it does not require high voltage and a frag- 
ile htgh-v^*Mium camera tube. We therefore recommend the use of a sol- 
id-siat» V .uiu'ra in t lie physical simulation. This will help to uncover 
; subtle problems related to camera problems such as blooming, Image 

granuLiritv anJ resolution, lens adjustments, dead picture elements, 
and v inat ions among picture elements in dark signal and sensitivity. 

The cixnputer used in the simulations should be equipped with interfaces 
to drive the simulator and to receive information from the television 
camera. It flashing lights are used, it will also require an interface 
; to synchri'^'ze light flashes with the computer's calculations* Any 

video signal processing that would be done in hardware in a real space- 
cratr i lould ho clone in similar hardware iu the simulation to evaluate 
hanj*\irc dt'sii;n problems and shortcomings. Aside from these require- 
\ ir.^ats, the computer does not have to bo particularly large or fast. 

The program could, In fact, fit Into many personal computers. 
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IV. The Three Systems 
That Were Simulated 


IV. 


THE THREE SYSTEMS THAT WERE SIMULATED 


Three separate video guidance systems were simulated in this study. 

This chapter describes the technical details, computer models and key 
mathematical equations used in each system to derive relative position 
and attitude. 

One of the most formidable challenges in autonomous video guidance is 
recognizing and analyzing the target. The image analysis must be done 
quickly, because a long computation delay degrades the performance of 
the control system. The analysis must also be accurate, because posi“ 
tion data will be used to determine velocity and perhaps other parame- 
ters. For example, if the target is tumbling rapidly, the control sys- 
tm may have to estimate parameters for predicting what the target's 
attitude, attitude rate, and rotation axis will be when the two space- 
craft touch. 

Whether this is a job for a mainframe computer or an inconspicuous 
electronics package depends largely on the design of a docking aid on 
the target spacecraft. In all of the simulated systems, the docking 
aids were designed to be analyzed with a minimum of onboard intelli- 
gence. Each system uses a hardware analyzer that reduces the video 
data to a small set of parameters. This approach gives these systems 
high speed without placing a heavy burden on the flight computer. 


A. IMAGE OF THREE LIGHTS GIVES ATTITUDE AND POSITION IN FIRST SYSTEM 


1. Description of Technique 

The first system, developed in 1980 at Martin Marietta under IR&D task 
D-llR, is the simplest of the three systems. It uses a docking aid 
that consists of the three lights (Fig. lV-1). By using a simple dedi- 
cated electronic circuit and a small routine in the flight computer, 
this system can analyze the docking aid in approximately 100 millisec- 
onds. The speed and simplicity are achieved by giving the analyzer a 
very simple job: finding the coordinates of a spot of light in a tele- 

vision image. 

The simplification results from the fact that only one lamp is on at a 
time. Bright flash lamps are used so that the lamps are by far the 
brightest objects in the television image. The dedicated electronic 
analyzer can therefore analyze the image by simply finding the coordi- 
nates of the center of brightness of the image as a whole. 

There are several ways to make individual lamps stand out without 
flashing the lamps in sequence. Colored lights and polarization, for 
example, can be used to give each lamp a unique ’’signature.’* 
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Figure IV-1 Flashing-Light Docking Aid 

Three Sequentially Flashed Lamps Provide Full Relative 
Attitude and Position Information with a WMimm of 
Computation, In the Basic Configuration^ Lamp Flashes 
are Directly Controlled by the Chase Vehicle •via a 
Radio Cormanc Link, But Varia-tions Not Requiring a 
Command Link Are Discussed in the Ten-t. 


However, sequentially-flashed lamps have three significant advantages: 

1) The system can very easily determine which lamp is which. 

2) The flashes can be synchronized to a shutter on the camera so that 
light from other sources can got to the camera only during the 
flash. This reduces the effective brightness of background "clut- 
ter" by a factor of 30 but does not change the effective brightness 
of the lanp. Further reduction in background lighting can be real- 
ized by comparing an image showing the lamp flashing with an im>>!^e 
showing the lanp off. 

3) The flash duiatlon is short, about a millisecond. This is short 
enough to fit into the television camera's retrace interval so that 
there is no question about whether the flash occurred before or 
after the corresponding picture elements were scanned. Flashing 
during the retrace also allows the analyzer to process a different 
lamp on each video frame, greatly speeding the analysis. If an 
Integrating sensor is used (a charge coupled device or vidicon), 
the electron image left by the flash will remain in the sensor 
until the image is scanned. 

When the three lamps are flashed In sequence, high attitude rates may 
cause image distortion. This distortion can be partially corrected by 
flashing one of the lamps twice, noting the change in the location of 
the center of brightness, and adjusting the other two light locations 
accordingly. 
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2. Camera and Video Processing 

The center of brightness or "centroid" of an Image Is defined by the 
coordinates: 

\ ^ /*V(t)X(t)dt/ /*V(t)dt 

J frame y frame 


and 


Y 

c 


k 


f. 


V(t)Y(t)dt/ 

frame 



V(t)dt 

frame 


(IV-2) 


where : 

k is a constant that depends on scan rate and amplitude; 

V is the video signal with blanking and synchronizing pulses removed; 

X and Y are the horizontal and vertical deflection, varying from a neg- 
ative value at the left side or bottom of the image to a positive value 
of equal magnitude at the right side or top of the image; 

t is time. 

These coordinates can be computed with analog electronic components 
such as multipliers and Integrators, cr they can be approximated with 
digital components such as counters, adders, and accumulators. Multi- 
plication of the video signal by the deflection signal is reduced to a 
gating operation if the video signal is converted to a two-level digi- 
tal signal with a comparator, but careful selection of the comparator 
threshold is required to ensure that the lights and background are 
reliably separated by this technique. 

The choice of technology for implementing equations (lV-1) and (IV-2) 
will depend on a number of factors including environmental factors, 
reliability requirements, and camera type. In general, it will be con- 
venient to uses an analog approach with vidicons and other cameras that 
use an analog deflection signal. A digital approach may be more con- 
venient for systems using self-scanned solid-state arrays. Figure IV-2 
illustrates the analog approach. 
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Figure IV-2 Analog Centroid Computer 

The Centroid Coordinates X and Y Are Valid at the End of a Frame, 
The Boxes Labeled '*a*b'* Are Analog Dividers. 


Besides computing the image centroid, the video preprocessing circuit 
Is required to synchronize the scanning of the camera with the flashing 
of the lights. This can be done quite easily if the circuit directly 
commands the lights by a low-power radio link. This approach has a 
number of advantages: 

1) It is a simple matter to detenoine which of the three lamps is 
flashing if each is commanded individually. (The lamps must be 
uniquely identified for proper image interpretation); 

2) Operation with multiple targets in the same area is simplified, as 
each can be assigned a unique code or radio channel; 

3) The lights will flash only when they are needed; 

4) /kiquisition of the target is simplified; 

5) Very little power is required, since the transmitter's operating 
range is only 300 meters. 

An alternate approach to synchronization, phase locking to independent- 
ly flashing lights, may reduce the cost of the total system when one 
(or a few) chase vehicles are used for many missions. In such a sys- 
tem, the target cost and complexity are reduced at the expense of a 
more complicated chase vehicle system. 

When target simplicity is most important, the flash-lamp approach will 
be less attractive. The same pattern of three reference points on the 
target can be used in a much simpler docking aid, but with retroref lec- 
tors and colored filters replacing the flash lamps. A color television 
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camera is then used to distinguish among the three points, and a flash- 
ing light on the chase vehicle supplies Illumination. If lighting is 
favorable, cost could be further reduced by using painted spots for the 
reference points. In either case, the reference points are distin- 
guishable by the ratios among the red, blue, and green camera outputs. 
The color-camera approach allows the video preprocessor to find all 
three centroids from a single video frame, sc image distortion from 
vehicle motion will not need correction. 

After finding the coordinates of the three lamps in the image, the sys- 
tem determines the position of the chase vehicle in the instantaneous 
target reference frame. The calculations the flight computer uses to 
do this are found in subroutine POSIT of the program listing in Appen- 
dix A. The calculations are derived from the positions of the lights 
in an orthographic projection of the light pattern. This projection is 
a good approximation to the appearance of the image when the distance 
from the camera to the lights is many times greater than the distances 
between lights, and although perspective effects become significant at 
close range, the equations still properly indicate the direction to the 
docking axis of the target. The perspective effects do not cause seri- 
ous problems if the camera and docking aid are set back from the dock- 
ing fixtures so that the camera is a few meters from the lamps when the 
two spacecraft are docked. 

Orthographic projection was used in deriving the equations to minimize 
the amount of calculation. A more accurate solution could be developed 
to consider perspective effects, or a correction algorithm could be 
used to refine the position estimate provided by the simpler equations 
presented here. Unless the camera must be mounted at the very front of 
the chase vehicle, such Improvements produce little measurable benefit. 

3. Equations Used 

There are two aspects to attitude control with this system: the camera 

must remain pointed at the docking aid, and the chase vehicle must de- 
termine the target spacecraft's attitude and match it to dock pro;v^rly. 

Camera pointing is the easiest. Yaw and pitch errors are simple trigo- 
nometric functions of the coordinates of the center light's image on 
the television screen: 

“pitch ■ ““-‘<’'2/0 (JV-S) 

“ymi ■ (IV-4) 

where (u^, are the coordinates of the i th lamp's image on the 
camera-focal plane and f is the lens focal length. The roll error can 
be approximated by the angle between horizontal and the line connecting 
the images of the two side lamps: 
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atan 2 (v 3 -v^,U 3 - uj) 


(IV-5) 


'roll 


where atan2 Is the FORTRAN two-argument arctangent function. This 
formula is accurate only when the camera is in line with the x axis of 
the docking aid, but since roll errors are usually unimportant until 
the Instant of docking, and the guidance system forces the chase vehi- 
cle toward this axis, the formula works very well in practice. Subrou- 
tine RPY of the simulation program uses these formulas to correct atti- 
tude after each light -flashing sequence, as long as the lights are in 
the camera's field of view. Alternate formulas that use the "state 
estimate" from an onboard mathematical dynamics model are used when the 
light cannot be seen. These formulas are found in subroutine ESTRPY, a 
complete discussion of which will be found in Qiapter VIII. 


The more complicated problem of determining target spacecraft attitude 
is solved by comparing the camera's position in two different coordi- 
nate systems. The first system is a reference frame centered at the 
center docking-aid light and parallel to the target-body frame (Fig. 
II-2). This may be called the “docking-aid" frame. Ttie second coordi- 
nate system is the so-called "primary" reference frame used for naviga- 
tion. The latter frame is a nonrotating frame that is centered at the 
center of mass oJ the target spacecraft and is parallel to the chase 
vehicle body axes at the Instant the video guidance system takes con- 
trol. (See Chapter VIII for a more complete discussion of this coordi- 
nate system.) In the simulation program, the calculations for deriving 
target attitude are done in subroutine ATITUD, which calls the lower- 
level subroutines FINDCV, QUATRN, and DIRMAT. 


Subroutine FINDCV computes the camera's position in a coordinate system 
parallel to the primary coordinate system but centered at the center 
light. The equation it uses is: 




+ u^ + 


in which: 


(IV-6) 


£, represented in the program as CVPOS, is the required camera position 
vector. 


p, represented in the program as RHO, is the measured range from the 
camera to the docking aid. This value is provided by subroutine POSIT, 
which was previously discussed. 

U 2 , V 2 « represented in the program as UC and VC, are the coordi- 
nates of the center light's image at the focal plane of the camera as 
in equations (IV-3) through (IV-S). 

A^, represented in the programs as ACVT, is the transpose of the 
chase vehicle's attitude direction cosine matrix, which is obtained 
from the inertial measurement unit. 

f, represented in the program as FOCLEN, is the lens focal length. 
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To cu'* ‘ the target’s attitude, the guidar*. system uses and anoth- 
er . jr^ which defines the camera’s p i in the '^docking aid” 

refers ruo frame. In the program, _r is repr^« • ted by the array RELPOS 
and i:' ^uHruputed from the image appearance i' ..broutine POSIT. Subrou- 
tine QUaTRN computes the t«irget attitude ^nion with the following 

f onuular'; 


a ^ ^ S, product) 


^ ^ tan‘ 




I 


w 8in((>/2)/ |wl 
cos((^/2) 


(IV-7) 

(1V>8) 


(IV-9) 


S - A 
— c 


-2(qJ <12 - qa qO 

qj 2 _ q |2 ^ ^-2 « ^-2 

-2(q2 qs + qj qij) 


e - tan*l(S3/S2) - tan"^ 


/V3 - VI V 
\ Ul - U3 / 


(IV-10) 


(IV-11) 


3l 


r bin(0/2)/|r| 
CO6(0/2) 


(IV-12) 


3^ a." (quaternion product— see Appendix D) (IV-13) 

In which: 

represented In the program as QT, Is the required quaternion, 

£ and c are the camera position vectors defined previously, 

Up V| are the coordinates of Che image of lamp 1 at the camera 
focal plane, as before, 

A^. , repiosented in the program as ACV, is the chase vehicle attitude 
direction cosine matrix from the inertial measurement unit, 

Tl»e remainder of the variables are intermediate results. 

The physical interpretation of this procedure is as follows. Tt»e vec- 
tors £ and £ both represent the line of sight, or the camera's position 
with respect to the docking aid, but they are expressed in two differ- 
ent coordinate systems that have a common origin. The onboard computer 
knows tha orientation of one of those coordinate systems, because that 
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system Is the reference frame for its inertial measurement uuit. The 
other coordinate system, which is parallel to the target's body axes, 
is unknown. 

The computational strategy is to initially assume that the two coordi- 
nate systems are identical. If they r.re, r^ and £ should have identical 
nunerical values, and the observallons should agree with predictions 
based on projective geometry. The assumption is probably wrong, -n 
they probably won't. 

The computer's task is to find a rotation that will give predicted ob- 
servations that agree with what the camera sees. 

Consider what happens if the docking aid coordinate system rotates and 
r retains its orientation with respect to that system (£ rotates with 
the coordinate systan). If the docking-aid coordinate system is ro- 
tated to align with the primary frame, £ and £ will point in different 
directions. This is where the computer starts: assuming that the co- 

ordinates systems are aligned and noting that £ and £ have different 
mnerical values (Fig. IV-3). 



tht CoorHiimt 0 Sy$t4m Hav« Bstn Aligntd. Thia Hia^ 
eligrta e esui £. 


Figura IV-Z Intarprataiicn of r and c 


lomediately the computer senses that something is wrong. The vectors £ 
and £ don't line up, so the first step is to find a rotation of the 
docking-aid coordinate system that will line them up. 

The SBtallest rotation that will align £ and £ is a rotation about the 
axis defined by the cross product £ x £ (equation (IV-7]). The magni- 
tude of the cross product is |£| £ sin*^ , where 4 is the required rota- 
rion angle. Similarly, the dot product £«£ i*lr| Iclcos The ratio 
of these quantities is ~ 
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which allows the computer to determine ^ (equation [IV-8]). 


(IV-IA) 


An axis of rotation and a rotation angle define a quaternion (Appendix 
D), and this quaternion, , is computed with equation (IV-9). 

This quaternion only partially specifies target attitude; any rotation 
of the docking-aid frame about jr leaves £ and c_ aligned, so there are 
an infinite mmber of target attitudes to select from, as Figure IV-4 
illustrates* Some other method must now be found to find the proper 
rotation about the line of sight* The approach here is to use the 
appearance of lamps 1 and 3. 



Figure IV-4 Alternate Attitude Interpretations 

An Infinite Number of Target Attitudes Align r and c. 
Four Possibilities Are Shown in (a) through C3.) . 


A vector from lamp 3 to lamp 1 lies parallel to the docklttg aid y axis 
and points in the -y direction* This vector's orientation in the tele- 
vision image can be measured: 




tan”^ 


/V3 - vi ^ 
\-(u3 - ui) / 


(IV-15) 


IV-9 




(The minus sign in the argument's denominator shows that the positive 
horizontal axis of the image is aligned with the negative y axis of the 
chase vehicleO 


The vector's orientation can also be predicted* Suppose that £' rep- 
resents the target attitude* If At is the direction cosine matrix 
that corresponds to £' . 


s 


A 

c 



(IV-16) 


is a unit vector in the direction of the target's -y axis but expressed 
in chase vehicle coordinates. The expression 

0 

-1 

0 

can be evaluated with equation (D-5) from Appendix D* The result is 
equation (IV- 10 ). 

The projection of £ onto the y-z plane of the chase vehicle's coordi- 
nate system (which is parallel to the camera focal plane) gives the 
predicted orientation of the vector in the television image: 



6 o ■ tan' 


rl 


S3 

s7 


(IV-17) 


Perspective effects may produce errors of approximately one or two de- 
grees at close range, because this procedure uses orthographic 
projection. 

The difference between 62 and 6 2 is the required amount of rotation 
about the line of sight, and the axis of rotation is defined by a unit 
vector in the direction of jr. The axis and rotation define a second 
quaternion (equation (IV-12)). 

Finally, the computer calculates the net rotation to get the target 
attitude* The associated quaternion is found from the quaternion prod- 
uct of £' and £" in equation (IV-13)* 

Mission Constraints and Compatibility 

Except for the camera position requirement — the camera must be set back 
far enough from the front of the chase vehicle to avoid severe image 
distortion — this approach to video guidance imposes few mission con- 
straints* For example, it can operate in total darkness or full sun- 
light as long as the sun does not enter the field of view* Unlike the 
other approaches, this approach allows the docking aid and camera to be 
offset from the docking fixture, simplifying the design of the system 
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and reducing the impact on other systems. Further, it computes posi- 
tion and attitude fast enough to allow its use with targets that tumble 
several degrees per second, although other factors may make docking 
with such a target impractical. (Other parts of :he control system may 
not be able to keep up with such rates, the thrusters may have too lit-- 
tie control authority, or the docking mechanism may not be strong 
enough to withstand the stresses. Moreover, the Kalman filter in the 
simulated control system was not designed to estimate tumble parame* 
ters, and the goal-setting logic used in the system does not optimize 
trajectories.) With improvements in these portions of the control sys- 
tem, the three-light approach might do much better with tumbling tar- 
gets than the simulation results suggest. 

Although the system requires a computer, it is likely that an autono- 
mous spacecraft will require one with any rendezvous system. Very 
little additional hardware is needed beyond what one might expect to be 
required for other functions. The additional hard^/are consists of a 
television camera, a handful of electronics weighing perhaps two kilo- 
grams including packaging, and a low-power command transmitter with a 
range of 300 ueters. Power requirements will depend on the camera type 
and other implementation details, but it is reasonable to assume the 
added hardware can be designed to consume less than ten watts. Because 
the system is used for only two to four minutes, the energy requirement 
Is negligible when compared to the requirements of other onboard 
systems. 

If the flashing-light approach is used, compatibility with target 
spacecraft systems must be considered carefully. The spacecraft must 
provide power to the lights and command receiver, and although the en- 
ergy requirement is small, it may result in a requirement for solar 
panels and a power system on a spacecraft that otherwise has no need 
for them. Other potential compatibility problems with the target 
spacecraft include interfering with science instruments by blocking 
their fields of view, overpowering instruments with bright lights, or 
generating electromagnetic interference. The impacts cn propulsion , 
telemetry, coarse rendezvous, launch vehicle, and ground support sys- 
tems cannot be meaningfully evaluated without specific details of the 
mission. However, the small size, ruggedness, low power requirement, 
and speed of the technique will minimize problems. 

*). Measurement Model for Simulation 


The simulation program used the perspective projection techniques de- 
scribed in Chapter IX to provide ’’measurements" from this system* The 
program simulated motions of the chase vehicle and target between the 
three light flashes of a single measurement, because this motion pro- 
duces image distortion that may affect accuracy. The effective resolu- 
tion of the camera is determined by the random shifting of computed 
image coordinates in subroutine FLASH. Normally distributed random 
shifts were added in horizontal and vertical directions. The mean 
shift was zero, which models negligible fixed biases, and the standard 
deviation was l/600th of the width of the field of view, which models 
an effective vesolutionof 380 television lines. This is comparable 
with standard commercial television. Better accuracy was obtained with 
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better resolution, and resolution as coarse as 128 lines allowed reli- 
able docking with good control. 


B. PROJECTED RAINBOWS AND STEREO RANGEFINDING FORM SECOND SYSTEM 


Description of Technique 

In the second system, a beacon on the target spacecraft projects **raln- 
bows” of light. The apparent color of the beacon, viewed from the 
chase vehicle, depends on the angle between the docking axis and the 
line of sight. If the light from the beacon appears blue, the chase 

vehicle Is to the left of the docking axis; If the light appears yel' 

low, the chase vehicle Is on the docking axis; if the light appears 

red, the chase vehicle is to the right of the axis. The beacon also 

projects a second rainbow and rapidly alternates between the two. The 
second rainbow shows whether the chase vehicle is above or below the 
docking axis. In the simulations. It was assumed that the beacon Is 
directly commanded by the chase vehicle by radio, but other approaches 
are possible. For example, the chase vehicle could send a radio signal 
to Indicate which rainbow is active, or the chase vehicle's guidance 
system could synchronize to a one-two-off flashing sequence. 

To detect the colors, the system uses a prism spectrometer as Illus- 
trated in Figure IV-5. Light from the beacon is refracted in the 
prism, and the angle of refraction is a function of the wavelength or 
color of the light. A linear Charge Coupled Device (CCD) array behind 
the grating detects this deflected light, and the position of the 
brightest spot along the array indicates the color. The system locates 
the bright spot with a peak detector that monitors the video signal 
from the CCD array. The peak detector records the number of clock 
pulses required to scan out the brightest picture elem^^nt in the line, 
and the count is used to compute the wavelength or distance from the 
docking axis. 



Light ft^m the Beacon la deflected by the Prtam by an 
Angle Which Depends on Wavelength. The Electronicc 
Convert This Deflection to a Measurement of the Chase 
Vehicle's Angular Separation from the Docking Axis. 


Measured 
Angle 
Off Axis 
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The two television cameras used in the stereo rangefinder are mounted 
on opposite sides of the chase vehicle (Fig. IV-6) to maximize the in^ 
terocular distance. Both cameras find the center of brightness, the 
location of the beacon in the image, by using the centroid detector 
technique used in the three-light system. The range to the target is 
computed by comparing the center-of-brightness calculations from the 
two cameras. 



Cameras 


Figure IV-^6 Stereo Rangefinder on the Chase Vehicle 

The Cameras Are Mounted on Opposite Sides of the 
Chase Vehicle for Greatest Stereo Effect. The 
Cameras Are Not Gimballed But Mounted at a fixed 
Angle to the Vehicle Frame. 


The center-of-brightness information is also used to point the color 
detector, which has a much smaller field of view than the cameras. 

Because accuracy at 300 meters calls for precise alignment, the cameras 
are mounted rigidly to the frame of the chase vehicle; they are not 
gimballed • 

Figure IV-7 is a block diagram of the rangefinder. Two centroid calcu- 
lators, similar to the one in Figure IV-2, calculate the image-plane 
coordinates of the image of the beacon, and an onboard computer uses 
the coordinates to calculate the distance to the target and to keep the 
cameras pointed at the target. The system provides 30 range measure- 
ments per second. 
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Figure IV-7 Stereo Rangefinder Block Diagram 

The Video Signals from the Cameras Are Processed to 
Determine the Center of Brightness for the Images 
of a Beacon on the Target Spacecraft. The Range Is 
Updated by an Onboard Computer Using Equation (4-18). 
The Centroid Calculators Are trie Same As in Figure 
IV-3. 


2. Equations Used 


The range formula* is: 
fd(X. + X ) 

p & 1 (IV-18) 

(Xj^ + V " 

where 

^ is the estimated range, 

d is the Interocular distance (see Figure IV-8), 
f Is the camera leqs focal length, 

Xjiand Xf are the distances along the image plane from the center of 
the field of view to the image center of brightness for the left and 
right cameras, respectively, and 

AX Is the tolerance on X^ and Xf, which includes: 

- Ihe effects of having discrete photosensitive sites In the Image 
plane, 

Uncertainty In camera boreslghtingf 
Scan position uncertainty; 

*Equatlons IV-18 and IV-19 are derived In Table IV-1. 
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Tolerances in the electronics that calculate the center of bright- 
ness of the image, 

- Image blur from motion and lens imperfections. 



Figure IV-8 The Stereo Rangefinding System and nomenclature 


Because the Guidance System Will Keep the Chase Vehicle Cameras 
Pointed Toward the Target, the Range Will Equal the Distance 
along the Perpendicular from the Camera Image Plane to the 
Object. Uncertainty (^X) in the Image Position Causes Uncer- 
tainty in Range (t^R). 


In the simulation program (Appendix B) this formula is implemented in 
subroutine POSIT, where P is represented by the variable RHO. If reso- 
lution is the only significant limitation on accuracy, the relative 
measurement error for moderate values of P is 


^ (IV-19) 

p fd 

The candidate system, for which AX » (line length)/760, has a measure- 
ment erior of approximately (0.2P/d) percent of the true range. 

Figure IV-9 is a graph of percent error versus range for a rangefinder 
w-.th 256 line resolution. Although the accuracy is +15X at the start 
of the rendezvous operation, the system achieves accuracy better than 
3% at ranges where accuracy is critical. 
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Table 17-2 Derivation of Formulae (JV-18) and (IV-19) 


1. Range - Consider the diagram in Figure iv ,, The maximum possible 
range, R^, can be determined by noting the similar triangles ABC and 
ADE. Since the ratios among the sides of similar triangles are equal, 

AE - (Ri)(X^ - Lx) It (IV-20] 

The same reasoning for the right camera gives 

d - - (Ri)(X^ - Ax)/f (IV-21) 

Combining (IV-20) and (IV-21) gives 

(Rl)(X - Ax) (Ri)(X^ - Ax) _ __ 

=1 + AE+d-AE - d UV-zzj 

which can be manipulated algebraically to give the maximum possible 
range : 

Rl - fd/(Xj^ + X^ - 2Ax) (IV-23) 

The same reasoning gives the minimum possible range: 

R 2 ■ fd/p(^ + X^ + 2Ax), (IV-24) 

The average of Rj^ and R£ is the estimated range: 


P ■ *s(Ri + R 2 ) 


£d(X^ -b X^) 

“ 4 (Ax) 2 


2. Range Tolerance - The range tolerance is half the difference be- 
tween Rj and R 2 : 


AR - ^sCRi - R 2 ) - 


2fdAx 

(X^ + X^)2 - 4 (Ax) 2 


Dividing (lV-26) by (IV-25) gives the relative error 
AR _ 2 Ax 

P X, + X ^ ^ 

I r 

At moderate ranges, (Xj, + Xj.)^ 4 (ax)^. (In the candidate sys- 

tem, (Xj^'t- Xf)^ is over 40 times as large as 4(&x)^ for ranges to 
300 m.J 

So A X can be ignored in (IV-25) with little error: 


• fd 

^ " X, + X 
t r 


(IV-28) 
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Table IV- 1 Conel 


Substitution of (IV-28) into (IV-27) gives 

AR ^ 2pAx 
P ’ fd 


(IV-29) 



Figure IV-9 Percent Error vs Range for Stereo Rangefinding System 
With a iO-degree Field of View and 256 Pixels Per Line, The Percentage 
Error Increases Linearly with Range at the Rate of 0.05%/m. 


Because the two cameras used for stereo ranging are not gimballed, they 
cannot look "croas-eyed" at the beacon* As the beacon moves betweeen 
the cameras in the last moments before contact, it leaves the fields of 
view of both cameras. A third camera is therefore used to allow at 
least pointing, if not ranging, during the last few seconds of the 
docking operation. This camera is mounted very close to the docking 
fixture so that the beacon will always be in its field of view. 

The third camera has a circuit like the one in Figure IV-2 to compute 
the beacon's center of brightness. The coordinates from this circuit 
are used in the flight computer to compute a vector £, which defines 
the camera's position in a coordinate system parallel to the primary 
coordinate system but centered at the beacon. The equation used is 
identical to equation (IV-6), except that the variable P (range) now 
comes from the stareo rangefiadirg system. The vector c^ plays the 
same role in this guidance system as in the three-light system. 
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From the data provided by the beacon color analyzer^ the system **knows*’ 
Its angular separation fiom the docking axis. The analyzer provides 
two angles, one for horizontal error (**yaw*’) and one for vertical error 
(*'pltch**). Itese angles are combined with the range information (p) tc 
give £, the camera’s position in a reference frame that is parallel to 
the target's body axes but centered at the aacon. In the simulation 
program in Appendix B, the calculations are found in subroutine POSIT, 
and £ is represented by the variable RELPOS. 

The flight computer therefore has available to it vectors that are 
analogous to the £ and c_ vectors of the three-light system. 

Unfortunately, the computer has no information to help it resolve the 
ambiguity in orientation about the line of sight. Unless it can re- 
solve this ambiguity, it cannot determine which way to steer to get to 
the docking axis. 

The solution to this problem is found in combining two separate meas- 
urements. Suppose, for example, that one measurement gives £ and £ and 
that the second measurement gives £' and £' • If the measurements are 
closely spaced in time, the target's attitude will not have time to 
change appreciably. Therefore only two coordinate systems are in- 
volved; the primary system, which is known, and the target system, 
which is to be computed. If A^- is the direction cosine matrix (see 
Appendix D) giving the target's attitude with respect to the primary 
f rame , 

£ * , and (IV- 30 ) 


£' “ \ • (IV-31) 

This is true because £ and £' are expressed in a frame parallel to the 
target frame and the frame in which £ and £' are expressed is parallel 
to the primary frame and has the same origin as the frame for £ and £' • 

The relationship illustrated in equations (IV-30) and (IV-31) holds foi 
any pair of vectors expressed in these two frames. For example, the 
cross product of £ and £' is related to the cross product of £ and £' 
by the same direction cosine matrix. So the relationship holds betweer 
the two matrices: 


"i- [ir i 

4 


(IV-32) 

"c- fic 



(IV-33) 

in which 



(IV-34) 

r 


c 


^ "nr 


’lir • 
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£ X £* 

jr X r' 


£ X £* 

^ |£ X £* 


(IV-35) 


k 

— r 




k - i X 1 
-X 4c 


(IV-36) 


Because of the way Mj. and are constructed (they are 3x3 ma- 
trices In which each col'jmn is a unit vector of a rectangular coordi- 
nate system), these matrices have the special property that their in- 
verses are equal to their transposes. The flight computer can there- 
fore find from these matrices by the formula: 

A - M . (IV-37) 

t r c 


In the simulation^ this formula is evaluated in subroutine QUATRN. The 
validity and usefulness of the formula depends on two requirements: 

1) The vector jr must differ significantly in orientation from _r * , and 
£ must differ significantly from c*. Otherwise, small errors in 
these vectors may make the results totally random. 

2) The target spacecraft must not rotate much between the time jr and £ 
are measured and the time £* and £* are measured. 

Unfortunately these two requirements conflict: if the two measurement 

sets are taken in rapid succession to minimize target rotation between 
readings, the measurement sets will differ by very little. However, if 
there is much delay between the two sets, the target may have rotated 
enough to invalidate the assumptions behind the formula. The delay 
also requires the chase vehicle to use stale data for an extended per-* 
iod of time. 

In the simulation program we tried only one approach to dealing with 
this conflict: we attempted to optimize the time interval between 

measurements. There are alternative strategies. 

Oiie strategy is to move the chase vehicle in a path perpendicular to 
the line of sight from time to time to maximize the difference between 
the measurement sets. This strategy would be combined with an expanded 
Kalman filter that estimates target tunble parameters. The additional 
cost in system complexity would be small, but th» approach wastes fuel 
and places a much heavier burden on the flight computer. 

An alternate strategy is to use two color-decoding circuits instead of 
one. One would be placed midway between the middle camera and the left 
camera; the other would be placed midway between the middle camera and 
the right camera. The resulting system would provide two separate 
color /rangefinder systems that would allow simultaneous measurement of 
both sets of data. Becauue of the close spacing of the instruments, 
the vectors in the two sets would be almost parallel until the chase 
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vehicle gets close to the target. This implies that good attitude in- 
formation is not available at great aistances* If the target's tumble 
rate is small enough so that elaborate trajectory planning is not re- 
quired, this should cause few probletsis* 

We did not simulate these approaches, because we felt that they would 
result in a system that was so much more complex and expcasive than the 
three-light system that even if they worked well, they would not be 
recommended. 

Mission Constraints and Compatibility 

Camera placement is a bigger concern with this approach than with the 
three-light system. Although the beacon, center camera, and color 
analyzer could be offset from the docking fixtures, there is a risk in 
doing so. The problem is that the algorithm for computing target atti- 
tude is not very robust. The factors discussed previously (too little 
chase vehicle motion or excessive target attitude change betweeen meas- 
urements) can cause errors in attitude computations. This problem is 
compounded when the stereo ranging cystem becomes ’’blind*’ during the 
critical seconds Just before docking as the beacon moves between the 
cameras, out of their fields of view. 

The loss of stereo ranging might be cured by making the outboard camer- 
as ’’crosseyed.” Although time did not pemit a simulation of this mod- 
ification, we believe it will greatly improve performance at close 
range. However, this change tightens constraints on camera placement 
and spacecraft design, since it will be harder to avoid obstructing the 
fields of view of the cameras. 

Because the ’’rainbow” beacon approach requires a significant delay 
between observations to properly derive target attitude, the approach 
is inherently slower than the three-light approach. We do not recom- 
mend It for use with rapidly tumbling targets. With modifications to 
the Kalman filter, it may be able to cope with modest tumble rates, but 
this has not been demonstrated. 

The burden on the onboard computer is greater with this approach than 
it was with the three-light approach, and it requires more hardware on 
the target and chase vehicle. If one considers only the hardware that 
would not be required w cnout the video guidance system, the difference 
in quantity is approximately a factor of five. The power requirement 
and weight can also be expected to Increase by a factor of five* Fur- 
thermore, the hardware in the ’’rainbow” system is more complex and less 
rugged . 

The beacon cannot use flash lamps, because it must produce a continuous 
spectrum. Although careful design may allow a low-power rainbow pro- 
jection system, we doubt that power consumption can be reduced tc with- 
in a factor of ten of what is possible with a three-light system. 
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Measurement Model for Simulation 


The measurement model for simulating the television cameti^s in the 
’’rainbow” system was identical to the model used for the th^ec-light 
system* The same resolution was modeled, and the same assumptions were 
made* The calculations are in subroutine CENTRD. 

The model for the rainbow itself, however, is unique. The program 
first computes the true angular error from the docking axis about the 
target z and y axes, lliis calculation fully takes into consideration 
the offset between the beacon and the target spacecraft center of mass 
and the offset between the color analyzer and the center of mass of the 
chase vehicle. 

The validity of the measurement is then tested. If the color decoder 
cannot ’’see" the beacon, the program recognizes that the measurement is 
unuseable, and the guidance system Ignores the measurement. 

Otherwise, the program adds a random number to the computed angle to 
simulate imperfections in the system. The accuracy of a ’’pitch” meas- 
urement can be expected to deteriorate when thi ”yaw” angle becomes 
large. Similarly, ”yaw” measurements will be poor when the ’’pitch” 
angle is large. As the colors get crowded close together near the axis 
about which they are spread out, it becomes harder to separate them. 

The program models this effect by making the corruption to "yaw” meas- 
urements proportional to ’’pitch” and by making the corruption to 
’’pitch” measurements proportional to ”yaw.” 

The program then rounds off the simulated measurements to the nearest 
multiple of 0.01 radian and limits the range of measurements to + 1 
radian. This procedure models the inherent quantization in the angle 
decoding circuit and the limited rainbow width achievable with a prac- 
tical lainbow projector. 

The computations for *yaw” measurements are in subroutine GETYAW. The 
computations for ’’pitch” measurements are found in subroutine GETPCH. 
The structures of these subroutines are virtually identical. Subrou- 
tine DOCK selects one or the other of these subroutines for each meas- 
jrement to model the fact that both measurement types cannot be taken 
simultaneously. 


C. IMAGE OF RING OF LIGHTS LEAVES ROLL UNDEFINED IN THIRD SYSTEM 


1 • Description of Technique and E qua tions Use d 

Figure IV-10 shows a third docking aid that can be analyzed with a 
small dedicated video signal processor. The required circuit (Fig. 
IV-11) uses the equations in Figure IV-12 to analyze a television 
image of the docking aid in 1/30 second. In the simulation program of 
Appendix C, this hardware analysis is simulated in subroutines LOCATE 
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and MCALC. The circuit comp'ites parameters defining an ellipse tha 
approximates the appearance of the image. These parameters can be in- 
terpreted in software to get position and attitude, except that target 
rotations about the target x axis produce no visible effect. This 
aabiuguity does not matter if the docking fixture is at the center of 
the ring of lights and allows mating with an arbitrary roll misalign- 
ment and if the camera is mounted at the center of the chase vehicle's 
docking fixture. 





Figure IV^IQ Ring^of~Lighta Dooking Aid 

Ring Enoirolea Dooking Fixture, Spaoeeraft Body Coordinate 
Sye’tem la Shown, Dooking^Aid Coordinate Syatem Ja Parallel 
to Body Frarr But Centered at the Middle of tha Ring of Lighta, 

Because the video processor analyzes the Isuige as a %rhole, it is im- 
portant for the ring of lights to be the only significant source of 
light in the image. Flashing-light and color-keying approaches can be 
used with this dockii^ aid in tne same way they were used in the 
three-light system. All of the lights in the ring must flash simul- 
taneously if flash tubes are used. 

The parameters and from the scene analysis circuit are the 
coordinates of the center of the ellipse on the camera's focal plane. 
The moments I^x* Ixy* lyy intermediate reiiults that must 
be processed further in the flight computer. The computer calculates 
the ellipse semimajor and semiminor axes (a and b, respoctlvely) and 
the rotation of the s'mimajor axis from horizontal (6). The formulas 
are: 
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Figure IV~11 Possible Hardmre to Compute Centroid and Ellipse Paramters 
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Figure IV-12 Equations Solved by Circuit of Figure IV-ll 
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Thresholding of Video Signal Is Optional 
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a « k y max(Ai , 12 ) 



(IV-41) 

b “ k max(Ai,A2) 
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where k is a constant that depends slightly on the exact target geome- 
try* In this simulation, which models eight -point light sources, 
k =VTT These calculations are performed in subroutine EPAR in the 
simulation program. 


Because the roll component of the target’s attitude is not observable, 
the computer assigns it an arbitrary value. Specifically, roll orien- 
tation is assumed to place the camera in the X-Z plane of the docking 
aid coordinate system. This coordinate system is parallel to the tar- 
get spacecraft system but is centered at the middle of the docking aid. 


With this arbitrary roll value assigned, a vector r can be computed, 
which is analogous to the vector _r in the other two video guidance sys- 
tems discussed previously. The formulas are: 


P “ 0.5df/a 


(IV-43) 


S - b/a 


(IV-44) 


r 



(IV-45) 


where : 

Pis the range to the target, 

3 is the ratio of the lengths of the semiminor axis and semimajor axis 
of the ellipse, 

£ is the position of the camera in a reference frame that is parallel 
to the target spacecraft frame but centered at the center of the ring 
of lights. 
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In the simulation program, these equations are implemented in subrou- 
tine ELIP, and £ is represented by the array RELPOS. 

This system also computes a vector £, analogous to the vector £ in the 
other two systems. This vector specifies the camera’s location in a 
reference frame that is parallel to the "primary" reference frame used 
for navigation. The origin of this frame is at the center of the ring 
of lights. Equation (IV-6) is used to compute this vector as in the 
other two systems, except that and from the video-processing 
hardware fill the role of U 2 and V 2 in the equation. 

In the other two systems, £ and £ were combined to determine the atti- 
tude of the target. The same approach is used in this system, but the 
details of their use differ. 


In the three-light system, there was no ambiguity in the interpretation 
of an observation. A single measurement was therefore sufficient to 
define the chase vehicle’s position. In the "rainbow" system, there 
was an ambiguity because target rotations about the line of sight were 
not observable. Two different measurements were therefore combined to 
determine the target’s attitude uniqi ?ly. 


In the ring-of-lights system, there are two sources of ambiguity. 

First, target rotation about its x axis is undetectable. This ambigu- 
ity is unresolvable but causes no problems if the ring of lights en- 
circles the docking fixture as was discussed pre'dously. The second 
ambiguity is of greater concern; the target’s center of mass may be on 
either side of the major axis of the ellipse (Fig. IV-13). If the 
guidance system simply guesses, it will drive the chase vehicle farther 
from the docking axis. Instead of correcting position errors, it will 
make them worse. 


Target 
Center of 
Mass 



(a) Docking 
Axis 


Docking 

Axis 



(b) 


Figure IV- 13 Two Ellipse Interpretations 

In (a) the Chase Vehicle Should Steer Down and to the Right 
to Reach the Docking Aria. In (b) the Chase Vehicle Should 
Steer Up and to the Left. A Wrong Guess Results in an Un- 
stable Control System. 
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This problem is also solved by combining two measurements, but the 
method for combining the measurements is completely different. 

The procedure starts by picking a plausible interpretation from the 
equations: 

21 “ ^ £ (cross product), (IV-46) 


(p * tan~^ 



(IV-47) 


1 


t 


w sin((f)/2)/ |w| 
cos(<|)/2) 


(IV-48) 


These equations are identical to equations (IV-7) through (IV-9), which 
were used in the first two systems, and they serve the same purpose 
here. The quaternion defines a target attitude that aligns the r 
and vectors. This quaternion must now be corrected for rotation 
about the line of sight. In the first system this was done by compar- 
ing the observed target -y axis with a predicted observation tnat was 
based on q' . With the ring-of-lights docking aid, the -y axis cannot 
be observed. The -x axis, however, is known to lie along the ellipse 
minor axis in the image, and this fact can be used to form the correc- 
tion for rotation about the line of sight. The reasoning is identical 
to that used in deriving equations (IV-10) and (IV-11), but the use of 
a different axis results in slightly different formulas: 


S 


-q{2 + q»2 + 
-2(q{ + q| q^J) 

L2(qJ q4 - q{ q|) 



Y - 



- e . 
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(IV-50) 


where £ is the projection of the target -x axis unit vector onto the 
chase vehicle’s y-z plane. The angle y is the amount of rotation about 
the line of sight required to make the predicted ellipse appearance 
match the observed ellipse. The angle 8 , the orientation of the el- 
lipse in the image, is computed by the video signal processing hardware 
shown in Figure IV-11. 

The corresponding quaternion is computed with the equations: 

fr sin(Y/2)/|rn (IV-51) 

cos(y/2) J * 
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(IV“52) 


a - 1" 


The alternate interpretation, in which the target spacecraft’s center 
of mass lies on the opposiue side of the major axis of the ellipse, is 
formed by rotating the target 180 degrees about the line of sight# 

This rotation is done with the formulas: 



(IV-53) 


13 . 


f f I 
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All these equations are implemented in the simulation program in sub- 
routine QUAIRN, where q and the possible target attitude quater- 
nions, are represented by the first and second columns of the 4x2 array 
QT , re spec t ive ly . 

After the first observation of the target, the guidance system has no 
basis for preferring one attitude interpretation over the other, but 
after the second and subsequent observations, it can compare ^ and 
from the current observation with the values from the previous observa- 
tion. If the target is not tumbling too rapidly, one pair of attitude 
measurements will match closely. This pair can be assumed to represent 
the proper image interpretation. 

One problem in implementing this method is that the quaternions all 
contain arbitrary components representing roll about the target x 
axis. Some means is required for comparing two quaternions while ig- 
noring this roll component in each. The guidance system simulated in 
this study makes this comparison with the equations: 


a “ ‘iiQi'*’ qaQz + Q3Q3 * 

(IV-55) 

b “ + I2Q3 ” *13Q2 “ » 

(IV-56) 

6 ■ 

(IV-57) 


where £ and ^ are any two quaternions to be compared, and 6 is smallest 
possible Euler angle that will account for the difference between £ and 
making the most generous assumptions about the arbitrary roll 
angle. Here variables a and b are intermediate results and are used 
only to simplify equation (IV-57). They should not be confused with 
the ellipse parameters used in other formulas. 

Equations (IV-55) through (IV-57) are Implemented in the simulation 
program in subroutine TSTATT. This subroutine is called by subroutine 
SELECl to test all possible combinations of old and new target attitude 
interpretations to find the best match. SELECl returns pointers that 
indicate which pair is assumed to represent the true target attitude. 
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The guidance system uses the selected interpretation of the current 
observation for control, but it remembers both interpretations tor 
testing the next observation and for propagating the state estimate. 
IVo sets of parameters are maintained for the onboard mathematical dy- 
namics model. After each observation it throws away the parameter set 
that was based on the target attitude interpretation that the current 
observation shows to be false. This maintenance of two parameter sets 
minimizes errors caused by operation with a tumbling target. 

2. Mission Constraints and Compatibility 


Because this syst&a cannot detect roll misalignment of the two space- 
craft, it is essential that such a misalignment makes no difference. 

This requires the camera to be mounted very close to, or even within, 
the docking fixture. The ring of lights must encircle the docking fix- 
ture of the target spacecraft. Also, the docking fixtures must be de- 
signed to operate properly with an arbitrary roll misalignment. 

The hardware power requirement for this system will probably be only 
slightly more than that of the three-light system, and the hardware is 
not much more complex than that system’s hardware. The burden on the 
flight computer is also slightly greater. 

In all other respects, the mission constraints imposed by this system 
will be essentially the same as those imposed by the three-light system. 

3. Measurement Model for Simulation 


The simulation program used the perspective projection techniques de- 
scribed in Chapter IX to provide "measurements’ from this system. The 
center of brightness coordinates for each light were corrupted to rep- 
resent 380-line television resolution. The method used to do this was 
the same as the method used with the three-light system. The equations 
in Figure IV-12 were simulated with summations that approximated the 
required integrals. These calculations are in MCALC of the simulation 
program* 
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V. Simulation Results and 
Discussion 


V 


SIMULATION RESULTS AND DISCUSSION 


A. THE THREE-LIGHT SYSTEM WORKS BEST 


In more than 50 simulations run with the computer programs in Appen- 
dices A through C, the three-light version consistently outperformed 
the other two systems. Figure V-1 shows six typical trajectories pro- 
duced with the three-light system. Each simulation started with the 
chase vehicle at a random position approximately 300 meters from the 
target spacecraft and was assigned a random initial velocity. Target 
attitude varied from one simulation to the next, but the target's atti- 
tude rate was zero. In each of these simulations, and several others 
not shown, docking was successful. 

Figure V-2 and V-3 show the results of similar simulations with the 
’’rainbow" and ring-of-lights systems, respectively. Both systems per- 
formed reasonably well at distances over 150 meters from the target, 
but both had trouble at close range. The "rainbow" system successfully 
docked or came very close most of the time, but the final alignment was 
never as good as the three-light system achieved. More serious is the 
fact that the system occasionally became "confused" and wandered away 
from the target. This is what the control system is supposed to do if 
the target leaves the field of view of the television cameras. It is a 
preprogrammed maneuver to avoid a collision when the system is 
"blind." However, the system should not have had to take this action 
with such benign starting conditions. 

In some simulations where the simulation time limit was increased, the 
chase vehicle made another pass at the target when this happened. The 
onboard mathematical model, described in Chapter VIII, was provided to 
allow recovery from a temporary loss of imagery. We believe, however, 
that it is significant that the three-light version did n^t have the 
problem. 

Three explanations can account for this behavior of the "rainbow" 
system: 

1) The projected rainbow does not produce valid data when it is viewed 
from more than one radian from the docking axis. This restriction 
models what we believe to be a reasonable estimate of the limita- 
tions of a practical system; 

2) The stereo rangefinder's cameras are mounted at the sides of the 
chase vehicle, and at close range the image of the beacon moves 
toward the edge of each camera's field of view. Because of these 
two limitations, small errors in position and attitude at close 
range can cause loss of ranging information or Incorrect angle 
measurements; 

3) The chase vehicle may be moving too little between successive ob- 
servations, causing errors in determining the target's attitude. 
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Typical trajeatoHea with three-light eyatem: a) and b) ahow entire 

trajectory i c) through f) are oloaeup viewa of the laat 60 m» Ali^ 
trajeotoriea had an initial range of approximately 300 m. 






Figux*e V-2 

Typical Trajeotoriee with pauibow system: ay and b) show entire trajeotoryi 

a) through f) axv aloseup vijws of the Last 60 m. All trajeotories had an 
initial range of approximately 300 m. 
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Tupiaal Trajeatoriee with Ellipse eyatem: a) ard b) ahow enttre 
trajeatoryi a) through f) are aloaeup views of the last 60 m. A 
trajeotoriea had an initial range of approximately 300 m. 







The ring-of“lights system never docked successfully* In fact, in mos" 
of the simulations it appeared to actively avoid the target space- 
craft. The problem appears to be in the method it uses to resolve am- 
biguity in interpreting the image of the ring of lights. This ambigu- 
ity (Fig. IV-13), is resolved by combining pairs of successive obser^^a- 
tions, and the algorithm used is not robust enough to cope with modeled 
imperfections in the measurements and control system. We have found no 
simple algorithm change that measurably Improves performance. 


B. THE THREE-LIGHT SYSTEM WORKS WITH TUMBLING T*J<GETS 


Because the “rainbow" and ring-of-lights systems did not work well even 

with an inertially stable target, we believed it was pointless to test 

them with tumbling targets. We therefore concentrated on testing the 
three-1 ight system. 

Figure V-4 shows trajectories for target roll rates of 540 to 40,000 
degrees per hour. The control system appears to handle rates up to 
20,000 degrees per hour with good accuracy. Above this rate, perform- 
ance is degraded by gyroscopic torques caused by attempting to maintain 

roll alignment with the target at all times. If the chase vehicle did 

not rotate in synchronism with the target, much better performance 
could be expected, because the accuracy of the measureraentr is net 
measurably degraded at 20,000 degrees per hour. (Rotation affects the 
measurement accuracy only by moving the lamps, and the motion during 
the time an observation takes is only 2 percent of the spacing between 
lamps.) However, if the chase vehicle does not rotate, the >cking 
fixture must be designed to accept relative rotation between the two 
spacecraf t • 

Figures V-5 and V-6 show the performance of the three-light system with 
target spacecraft that rotate about their pitch and yaw axes. Again 
the limiting factor was the control system, not measurement accuracy. 

If a control system is to operate with target attitude rates over 700 
degrees per hour above these axes, some form of attitude prediction 
will probably be needed. This can be Implemented without changing the 
structure of the contrei system but will require more parameters in the 
onboard mathematical dynamics model described in Chapter VIII. It may 
also require an increase in the number of state variables used in the 
Kalman filter portion of the control system. The result will be an in- 
crease of approximately 20 percent in the computational burden on the 
flight computer. We do not believe this will be a major problem in 
system design. 
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Ftgui^ V-4 . ^ 4 . 

Trajeotoriee uith thrae-light eyetem with vanoua target tmble ratee 

about the docking axis: a) with S40*/hri b) with 1000*/hr;^ c 
4000* /hr; d) with 20,000*/hr; e) with 12^000* /"hr; and f) wttn 20,000 /hr 




Figure K-. 
Trajeotor 
the pitch 
d) with 4^ 
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Figum V-6 

Tpojeotones uyith three-tight syetem with various twible rates about the 
yaw axis: a) and h) are a stereo pair with S40*/hr tumble rate; e) with 
IQOO'/hr; d) with 2000*/hr; e) with 4000*/hr; and f) vd-th 8000*/hr. 








C- THERE IS ONLY ONE OPTION 


The selection of the best system does not require a tradeoff matrix 
because only the three-light system worked reliability. It is inter- 
esting to note, however, that the system would be selected even if the 
other systems had performed as well. Consider how the systems compare 
in the 10 characteristics summarized in Table V-1. It is better than 
the other two systems in almost every column of the table. 

The table entries shown in the cost column are only for comparison and 
ate based on the known costs of hardware of similar complexity. Al- 
though the figures do not include such indirect costs as software de- 
velopment and impact on other systems, these costs can be expected to 
vary roughly in proportion to the hardware costs. None of the systems 
requires the expensive packaging associated with high voltage, none 
requires a zoom lens, and all can operate in the red/near-infrared por- 
tion of the spectrum for which inexpensive sensors are available. All 
of the systems will require some form of iris or threshold control, and 
this control will have comparable complexity in all three systems. 
Because the color sensor and rainbow beacon of the "rainbow" system are 
the only elements in any of the systems based on totally untried tech- 
nology, the "rainbow" system represents by far the greatest risk. 

All three systems have an algorithm hazard in common: they must be able 
to determine when the target is not within the television cameras* 
field of view. \^en the distance to the target is great, the video 
signal amplitude will fall with the square of the distance to the tar- 
get, and it may be difficult to determine whether the target is further 
away than expected or is out of the field of view. We recommend a 
physical simulation to demonstrate that a hardware system can solve 
this problem. 

In addition to this common hazard, the "rainbow" and ring-of-light s 
systems have the problems discussed previously that caused them to per- 
form poorly in the simulations. 

The speed of the three-light system is set primarily by the video frame 
rate, and the figure shown in Table V-1 is based on standard video 
rates. A special-purpose camera might be developed for higher speed. 
The other two systems, in contrast, are limited in speed by more funda- 
mental constraints. In both of these systems, two successive observa- 
tions are combined to define target attitude. Enough time must be al- 
lowed between observations to ensure that the observations are signifi- 
cantly different from one another. Therefore these two systems can 
never achieve the speed of the three-light system. 

Accuracy and television resolution are closely related. The resolution 
specified for the three-light system was based on simulations that 
showed the system works with resolution three times poorer. A factor 
of three safety margin was added to increase confidence while adding 
little to the cost; a 380-line resolution is approximately that of 
standard television cameras. 
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Table V-2 Tradeoff Matrix for Three Rendezvous and Doakimi Systems 


Criterion 
Svscetu N. 

Hardware 

Cost 

U) 

Algorithm 
Ha£di dik 
(2) 

Accuracy 

Speed 

Sire 

and 

Weight 

(equip 

(4) 

Tower 

Required 

Min /Max 
Range 



Resolution 

Required 

Rugged- 

ness 

and 

Hard- 

ware 

Relia- 

bility 

System 

Compati- 

bility 

3-Llght 

Svstem 

$300,000 

Moderate 

at 20 
Meters 

47X at 
300 Meters 

Up to 10 
Measure- 
ments 
per 

Second 

0.02 m^ 

10-lS Watts 

0-300m 

380 

Television 

Lines 

Good 

Good 

Rainbow 

System 

$300,000 

Severe 

4X at 20 
Meters 

7X at 300 
Meters 

Up to 1 
Measure- 
ment 
per 

Second 

(3) 

0.04 ra^ 
12 kg 

25 Watts 

0“300m 

380 

Television 

Lines 

Fair 

Fair 

Klllpse 

Svstem 

$300,000 

L. 

Seveie 

[_ 

41X at 20 
Meters 

23X at 300 
1 Meters 

\ ' ' 

Up to 1 
Measure- 
ment 
per 

Second 

> . 1 

^ 1- 
0.03 m 

8 kg 

20 Watts 

0-300m 

i 

380 

Television 

Lines 

Good 

Severe 
Pr Ob lams 


(1) For Comparison Only - Based on Cost per kg of Similar Hardware 


(2) See Text 

(3) Constraint Imv^osed bv Having to Take Two Measurements; It Measurements Are Too Close, Noise Will Be Dominant 

(4) Chase Vehicle Svstem 
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The resolution for the other two systems was specified at a level high 
enough to convince us that accuracy was not the dominant cause of fail- 
ure. Simulations with much better resolution demonstrated no better 
performance. 

All three systems are rugged, but the "rainbow" system uses a rainbow 
projector and a color detector that may require fragile parts and pre- 
cise alignment. The types and the quantity of components make this 
system rate the lowest in terms of hardware ruggedness and reliabil- 
ity. The differences among the systems are so great in other respects, 
however, that this factor is insignificant. 

Aj. 1 three systems place similar constraints on the system: 

1) Nothing must be allowed to block the field of view of the cameras 
or color detector; 

2) The propulsion system must be able to support the added mass of the 
guidance system; 

3) The power system must provide power for the additional hardware* 

4) The coarse rendezvous system must provide a sufficiently accurate 
estimate of the relative positions and velocities of the two space- 
craft to give the video system time to search for the target, lock 
on, and begin to track. 

Additional constraints are discussed in Chapter IV. However, of the 
three systems the three-light system imposes the fewest constraints; it 
has only one camera, and the camera does not have to be placed at the 
docking fixture, it requires the smallest amount of power and weighs 
the least. Even if the other systems worked well, they would place 
more constraints on the two spacecraft. 


D. THE HARDWARE TECHNOLOGY IS AVAILABLE 


The three-light system does not require any new developments In hard- 
ware to make it practical. It can use television cameras of standard 
resolution and speed operating in a convenient spectral band. The bur- 
den on the flight computer is modest and will not require a special 
computer design. 

We do not recommend, however, that fully autonomous operation be tried 
with the first such system built. We recommend that the system be used 
first as an aid in remote piloting of the chase vehicle. As the system 
proves its ability, it can be given greater autonomy from mission to 
mission. This approach of gradually Increasi.ig autonomy minimizes 
risks and allows the collection of valuable data that can be used to 
Improve system perfonnance. 
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VI. Two Other Candidate 
Systems 


TOO OTHER CANDIDATE SYSTEMS 


CORRELATION SYSTEM WAS TOO EXPENSIVE 


In most correlation guidance schemes, a reference scene is compared to 
the live scene from a television camera. The center of the reference 
scene is placed at different locations on the live scene, and the cor- 
relator computes the quality of the match with each alignment. The 
system uses the coordinates that give the best match between scenes for 
horizontal and vertical error signals. 

The rendezvous system cannot afford the time to do that because the 
misalignment can be in six degrees of freedom, not just two. The ren- 
dezvous system would have to match scenes with several different hori- 
zontal displacements for several individual vertical displacem !L\ts, for 
each zoom lens setting for each of several rotations of the camera 
about the optical axis, for each of several reference scenes showing 
the target from different angles. The number of comparisons required 
for each measurement is astounding, perh-ps ten billion at the very 
least, and each comparison may require 2000 or more operations. 

The number of comparisons must be reduced, and tais is possible. The 
guidance system can use the centroid-tracking and ellipse-fitting tech- 
niques described in Chapter IV to greatly reduce the number of degrees 
of freedom. The system we considered used these techniques to control 
the camera’s zoom lens and gimbal set. This was done to keep the tar- 
get image centered in the camera’s field of view, to maintain a con- 
stant image size, and to keep the major axis of the best-fit ellipse 
horizontal. The eccentricity of the best-fit ellipse was to be used to 
select a subset of reference scenes for comparison. The correlator 
would then need only to select the reference scene that best matched 
the live scene. 

Without question this system was the most complex of the five systems 
that were evaluated, though it was less complex than pattern interpre- 
tation systems and more tolerant of sensor imperfections. It had the 
advantage of requiring no special docking aids on the target space- 
craft. With modifications to its database of comparison images, it 
could, in principle, be used with any target. However, the scheme 
could not compete with the other concepts in accuracy or cost. 


CURVE-FITTING SCHEME DUPLICATED MSFC EFFORT 


R. Dabney of NASA’s George C. Marshall Spaceflight Center describes a 
video guidance scheme in MSFC memorandum ED15-81-71. His system used 
the same ring-of-light s docking aid as one of the systems described in 
Chapter IV, but its method for fitting an ellipse to the ring’s image 



was considerably different, and a different approach was used to derive 
guidance information from ellipse parameters. 

This system was not evaluated under this study, because more could be 
gained from the study of systems that had not already been analyzed and 
simulated, as this one had. 



VII. other Techniques 
That Were Investigated 
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OTHER TECHNIQUES THAT WERE INVESTIGATED 


Table VII-1 sunmarizes the approaches that wer^ considereJi for use in 
the video guidance system. Manv of these are discussed in detail in 
Chapters IV and VI. This chapter discusses the rejected apnroaches. 


Table V 11-^1 Techniques Investi jated 


- Interpreting an Image of Three Lights 

- Fitting an Ellipse to the Image of a Ring of Lights 

- Correlation 

Recognition of Corners and Edges 

- Projected Pattern from Target 

- Recognition of a Bar Pattern on the Target Spacecraft 

- Detection of Target Color, which Varies with Observer's Position 

- Stereo Rangef in<l * ug 
^ Stadiraetry 

- Rangefinding by Optical Focusing 


A. CORNER/EDGE RECOGNITION IS TOO EXPENSIVE 


Many of the studies on robotic vision have concentrated on the detec- 
tion of edges and corners. While this approach holds promise in many 
robotics applications, It is not recommended for an autonomous video 
rendezvous system. There are two reasons: 

1) Fast algorithms are easily fooled. The guidance system must con- 
tend with an image of extremely high contrast and with shadows that 
are almost totally black. Although contrast aids in the detection 
of corners and edges when the target's geometry is simple^ the var- 
iable collection of Instruments on the target r^'^cocraft will re- 
sult in a complex pattern of shadows that will m kv ige interpre- 
tation very difficult. 

2) Better algoritlims cannot compete in speed or cost. Speed is vital 
when the system must operate with tumbling targets, and software 
analysis of a complex image cannot come close to the speed of the 
other algorithms considered. Further, the better algorithms store 
the entire image, which may require as much as a quarter of a mil- 
lion bytes of memory. A detailed cost analysis is not required to 
conclude that such a system will be far more expensive than one 
that uses one of the selected algorithms. 
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B. 


BAR PATTERN REQUIRES HIGH RESOLUTION AND GOOD LIGHTING 


The Universal Product Code has been highly successful in automating 
checkout line3 in supermarket^ In principle, a Pimllar bar-^ode pat- 
tern could be used for locating key reference points on a spacecraft* 
Although this approach would greatly simplify the target, it greatly 
complicates the overall system. First, it requires good lighting to 
ensure that the bar ^^at terns are visible. Because the target may be 
tumbling, sunlight will be unreliable. While the problem is not insur- 
mountable (a backlit pattern might be used, for example), the approach 
remains more susceptible to lighting problems than the selected 
approaches. 

The hardest problem to solve, however, is resolving the details of the 
pattern. The pattern must be small if it is to be effective for iden- 
tifying reference points, and the small size makes it difficult to use, 
especially when the system must operate at all ranges from zero tj over 
300 meters. Other techniques such as those discussed in Chapter IV, 
circumvent these problems and provide the same capabilities at a lower 
cost . 


C. RANGEFINDING BY OPTICAL FOCUSING IS HARD TO USE 


Optical focusing, at first glance, appears to be a simple method for 
determining range, but a number of practical problems make it very dif- 
ficult to Implement: 

1) The system does not know what is in focus. A practical guidance 
system needs to determine the range to a known reference point on 
the target spacecraft to adjust approach speed for a soft contact 
with the target* A simple focusing system attempts to adjust for 
maximim sharpness of the image as a whole, and there is no guaran- 
tee that a known reference point will be in sharp focus. While 
this ii lot a probl^ at great distances from the target, it may 
cause stvere problems in deriving velocity at close range, and 
proper alignment of the docking fixture may require additional 
ha^ware that partially duplicates the function of the rangefinder. 

2) A telephoto lens is required at long range* Lenses with wide 
fields of view and modest F numbers have great depth of focus; one 
lens setting may produce sharp focusing for any range from a few 
meters to Infinity. A large -aperture telephoto lens is therefore 
required tj make effective use of optical focusing. Such lenses, 
however, are expensive and their narrow fields of view Introduce 
pointing problems* A gimballed pointing mount may be required, 
along with a complex state estimation algorithm to keep the target 
centered In the field of view of such a lens. 

3) Automatic focusing is a noisy operation. Sharp focusing Is detect- 
ed by measuring the high-frequency content in the video signal. 
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because sharpest focusing Is associated with the highest hlgh^spa* 
t ial-f requency content In an Image. Finding the point of sharpest 
focus is analogous to finding a point of zero slope on a curve of 
sharpness versus lens setting. Both operations involve the calcu- 
lus operation of differentiation* This operation is always "noisy" 
in that it emphasizes signal corruptions^ and the double differen- 
tiation is especially noisy* The result is that an accurate system 
will be slow, expensive, or both. 

Although it may be argued that accurate information is not required at 
great distances from the target, the simulations have shown that sys- 
tems which are not accurate do not work well. The problem is that the 
guidance system cannot determine the approach rate. Therefore, it al- 
lows the chase vehicle to drift away from the target or drives the ve- 
hicle toward the target at such a high speed that it cannot stop. 
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VIII. GENERIC VIDEO GUIDANCE SYSTEM 


The simulation programs in Appendices A thru C are adaptations of a 
single original program called DSIM, which was developed by Martin Mar- 
ietta to test our autonomous video rendezvous guidance system* The 
program and the guidance system were developed under IR&D project 
D-llR. Because a major portion of this guidance system is common to 
all three simulations, a detailed explanation of the system is 
presented . 

Figure VIII-1 is a block diagram of the control system, and each block 
corresponds, in general, with a subroutine or set of subroutines in the 
simulation programs* The exceptions to this rule are: 

1) Telemetry uplink and downlink have, not been implemented in these 
simulations; 

2} Several subroutines simulate television images of the docking aid 
and process them to obtain position and target altitude. These 
subroutines, which differ among the simulation programs, were writ- 
ten to perform specific functions rather than to correspond to 
specific hardware modules in the block diagram; 

3) Subroutine DOCK in each simulation is the “wiring” among the 
blocks; it sequences operations and passes data among blocks. 

Table KTII-J 

Relationship betveen Block-Diagram Blocks and Subroutines in the Simulation 
Programs 


Block Name 

Subroutines* 

Kaliun Filter 

IMCORF, (COMPG, ESTCOV, KALGAN, UPDSTA, UPDCOV) 

Mathematical Dynamics Model 

PROPES» RPY, ESTRPY 

Inertial Measurement Unit 

IMU, (niRMAT, AMGVEC) 

Goal-Setting Logic 

SETGOL 

Control Law 

THRUST, (CNTLAW, ACCEL, FIRTHR) 

Thrusters 

SELECT, (TABLEl, TABLET, TABLES) 

Chase Vehicle Dynsmlcs 

PROPTR, <C0MPK1, C0MPK2, C0MPK3, C0MPK4. POINT, 
STPRIM, ANGVEC, UNACL, MPRIME, FORCE, DIRMAT, 
TORQUE, LPRIHE, MAKROT, QPRIME) 

Target Spacecraft Dynamics 

TRGATT 

* Library routines such as matrix arithmetic routines srt not listed. 
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Table VIII-1 shows the correspondence between program subroutines and 
blocks in the block diagram. Subroutine names are shown in parentheses 
if they are not the primary routines involved in Implementing a block. 
These routines are called on by the primary routines to Implement low- 
level details of a function. 
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Figure VIII-l Genern Video Rendezvous Guidance Systems 

Only Major Signal Paths Are Shown, The Simulations Reported Here Do 
Hot Use TM Uplink and Downlink ^ and Only Minimal Forms of the Kalman 
Filter^ Mathematical Modelt and Goal-Setting Logic Were Implemented. 

A. THE KALMAN FILTER IMPROVES ACCURACY AND DERIVES RATES 


The Kalman filter combines observations to fine-tune the parameters in 
a mathematical dynamics model, providing accurate estimates of position 
and velocity. In these simulations, the filter adjusts six parameters, 
the X, y, and z components of position a^d velocity of the chase vehi- 
cle relative to the target. It can also be expanded to estimate such 
other parameters as target tunbling characteristics. 

Although a mathematical dynamics model is an essential feature of a 
Kalman filter, the model is considered to be a separate entity in this 
control system for two reasons: 

1) The model would be used in the ccntrol system even if the filter 
were nut. The primary reason the system maintains the model is to 
allow it to operate properly even when feedback is interrupted by 
obstruction of the camera's view of the target. The model is not 
simply a piece of the Kalman filter; 













2) The model contains parameters that are not adjust 3d by the filter* 
The parameters include the latest chase vehicle attitude quater- 
nion and angular velocity vector from the inert i?l measurnment 
unit, the latest target attitude measurement, information about the 
geometry of both spacecraft, an estimate of the mass of the chase 
vehicle, optical system parameters, and other data. 

The subroutine that implements the Kalman filter is called INCORP. 

Each time a new measurement is taken, this subroutine updates the state 
estimate (x) and the state covariance matrix (P) by calculating 


K-^PG^ (R+GPG^)“^ , 

x*-x+K(£-£) , 

P'1 (I-KG)P , 


(Vm-1) 

(VIII-2) 

(VIII-3) 


where 

K, represented in the programs as KGAIN, is a 6x3 matrix referred to 
as the Kalman gain matrix, 

P, represMited in the program as P, is a 6x6 matrix, the state covari.- 
a nc e ma t r i x , 

G, represented in the programs as G, is a 3x6 matrix, the partial de- 
rivative ot the predicted measurement with respect co the state. 
Since the measurements in all three simulations are the first three 
elements of the state vector, G is a constant with the value 

[ 1 0 0 0 0 o" 

0 1 0 0 0 0 

0 0 1 0 0 0 ^ 

It is, however, "computed" in subroutine COMFG to maximize the use- 
fulness of the program for other simulations in which G is not 
constant , 

R, represented in the programs as R, is a 3x3 matrix, the measurement 
covariance matrix. This matrix is calculated from an empirical 
formula in subroutine ESTCOV. The formula was derived by observing 
the measurement errors at various ranges in several rendezvous sim- 
ulations and fitting a curve to a graph of the mean square error 
versus range. In the design of a flight system a similar approach 
could be used, but test data and analytically derived tolerances 
would be used instead of simulation results, 

x, represented in the programs as ESTATE, is the estimated chase vehi- 
cle state. This is a six-element vector, the first three elements 
of which represent position along the x, y, and z axes of the so- 
called "primary" reference frame. The remaining elements are the 
velocity components along these axes. (The primary frame is a non- 
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rotating right-handed rectangular coordinate system centered at the 
target spacecraft’s center of mass but aligned with the body axes 
of the chase v<^hicle at the instant the video guidance system takes 
control) , 

represented in the programs as CVPOS, is a three-element measure- 
ment vector representing the measured position of the chase vehi- 
cle’s center of mass in the primary reference frame, 

g^, which is not explicitly represented in the programs, is the pre- 
dicted observation* In these implementations of the control sys- 
tem, £ is simply the first three elements of x, 

I, the 3x3 identity matrix, is not explicitly represented in the 
programs* 

The Kalman filter form used here does not have the best roundoff and 
stability characteristics for flight software, but is ideal for sim- 
ulations because it is easy to modify* 


B. THE MATHEMATICAL DYNAMICS MODEL ALLOWS DEAD RECKONING 


The mathematical model embodies the guidance system’s knowledge of the 
target spacecraft and chase vehicle. Some of this information — posi- 
tions of the cameras, docking aids and fixtures with respect to the 
spacecraft centers of mass, the optical focal lengths, the thruster lo- 
cations, orientations and thrust levels, and similar information — is 
known in advance. In the simulations, this information is passed to 
all subroutines that need it through common blocks. All these common 
blocks appear in subroutines INIPAR, where the variables are initial- 
ized and the variables’ definitions^ which vary from one simulation to 
the next, are given in comments with the type declarations in that 
subrout ine. 

A second class of information in the mathematical model is measured 
data that does not pass through the Kalman filter. Although the nature 
and use of this infonnation vary among the three simulations, all three 
programs maintain target attitude, chase vehicle attitude, and the co- 
ordinates of the lamp Images’ centers of brightness. 

The third class of information, which is identical in all three simula- 
tions, is the information processed by the Kalman filter. In the three 
simulations this class included only the position and velocity of the 
chase vehicle* These collectively referred to as the state estimate 
(ESTATE) and the state estimate covariance matrix (P). Additional pa- 
rameters could be added to improve performance with tumbling targets. 

In addition to a data base, the mathematical model has procedures for 
updating and using the data. The largest of these is subroutine 
PROPEE, which uses numerical integration to propagate the state esti- 
mate and covariance matrix between observations. The formulas it uses 
are 
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X = K2 X / m 

(VriI-4) 

Ax ^ (x + % X At) At 

(VIII-5) 

^ = XAt 

(VIII-6) 

AP = (FP + PF^ + NVN^)At 

(VIII-7) 


where 

^ and ^ represent the position, velocity, and acceleration vectors, 
respectively. The position vector is the first three elements of 
the array ESTATE, and the velocity vector is the second three ele- 
ments. The program variable name for 2 ^ is ACCEL, 

A is the transpose of the chase vehicle direction cosine matrix, as 
measured by the inertial measurement unit, which is modeled in sub- 
routine IMU. The variable name in the program is ACVT, 

K2 is a constant matrix relating the force magnitudes of all the 

thrusters to the force vectors they produce. The variable name in 
the programs is AK2, 

£ is a 14-element array in which each element corresponds to the mag- 
nitude of the force currently produced by one thruster. The pro- 
grams refer to this array as F, 

m is an estimate of the chase vehicle mass. The programs refer to 
this variable as AVGMAS, 

t is the time interval over which the state estimate is to be propa- 
gated. The variable is referred to in the programs as STEP, 

P is the state estimate covariance matrix. The correspoi vari- 

able name in the programs is P, 

F is the partial derivative of d(ESTATE)/dt with respect to ESTATE, 
which, in this context, is the constant matrix. 

"o 0 0 1 0 0 ” 

0 0 0 0 1 0 

0 0 0 0 0 1 

0 0 0 0 0 0 

0 0 0 0 0 0 

0 0 0 0 0 0 

This matrix does not appear explicitly in the programs because its 
effect is simply to select elements of P to be added together. The 
selection and addition were done more efficiently by avoiding ma- 
trix arithmetic, 
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NVN^ is a matrix that gives the covariance of stray (unmodeled) 

accelerations of the chase vehicle. These accelerations arise 
from uncertainty in thruster force magnitude from attitude 
changes between the time is measure! and the time it is 
used, from gravity gradient acceleration, from thruster mis- 
alignment, and from roundoff errors in computation. Because 
this matrix is sparse (only three elements out of 36 are non- 
zero), it is handled without using matrix arithmetic and is not 
explicitly represented in the programs. 

The mathematical model is also responsible for attitude control. Sub- 
routine RPY is used if the docking aid is within the field of view. It 
returns the changes in roll, pitch, and yaw required to align the chase 
vehicle's x axis with the line of sight between the camera and the 
docking aid. Subroutine ESTRPY is used when the docking aid cannot be 
seen. It estimates the changes in roll, pitch, and yaw required to 
align the chase vehicle's x axis with the line connecting the chase 
vehicle's center of mass and the target spacecraft's center of mass. 
ESTRPY operates on the state estimate (ESTATE) whereas RPY uses the co- 
ordinates of the center of brightness of the docking aid's image. 

ESTRPY is the same in all three simulations, but RPY is slightly dif- 
ferent in the three versions because of the differences in the docking 
aids among the three systems. 


C. THE INERTIAL MEASUREMENT UNIT PROVIDES ATTITUDE AND ATTITUDE RATE 
INFORMATION 


The guidance system uses the so-called "primary" reference frame to 
maintain estimates of relative position and velocity, and of the atti- 
tudes of both spacecraft. The primary frame is a nonrotating coordin- 
ate system that is initially aligned with the chase vehicle's body axes 
at the instant the video guidance system takes control. The center of 
the coordinate system is at the target spacecraft's center of mass. 

Since both spacecraft rotate with respect to this frame, the guidance 
system must measure the chase vehicle's attitude with each video meas- 
urement to properly interpret the imagery. Subroutine IMU supplies 
simulated attitude measurements from the inertial re^saurement unit for 
tliis purpose. Thie attitude is returned in the form of a direction co- 
sine matrix defining the attitude with respect to tho primary frame. 

The transpose of the direction cosine matrix and an angular velocity 
vector, used for control system damping, are also returned from the IMU. 

The attitude is determined by examining the "true" state of the chase 
vehicle, which Is maintained In the 14-element array STATE. Elements 
10 through 13 of this array are the current attitude quaternion and de- 
fine the attitude with respect to the "truth" coordinate system. Sub- 
routine IMU subtracts the initial attitude from the current attitude to 
compute attitude with respect to the "primary" reference frame used foi 
control. It then converts from quaternion notation to direction cosine 
notat Ion. 
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The angular velocity vector is found from elements 7 through 9 of 
STATE, v^/hich are the angular momentum vector, and from element 14 of 
STATE, which is the chase vehicle mass. The equations are 

1 = 1 + (m-m )dl/dm (VIII-8) 

o o 

^ A L (VIII-9) 

^ c — 

wlie re 

l, represented in the programs as the 3x3 matrix INERTA, is the 
total chase vehicle inertia, 

1^^, represented in the programs as the 3x3 matrix INERCV, is the 

inertia of the chase vehicle without fuel, 

m, mQ, are the mass of the chase vehicle with the current fuel load 

and the mass with no fuel, respectively. In the programs m is 
represented as STATE (10), and is MEMPTY, 

dl/dm, represented in the programs by the 3x3 matrix FULDIS, is the 
amount of additional inertia added for each unit of fuel, 

represented in the programs by the three-element array ATRATE 
(in subroutine IMU ) or BODVEL (in subroutine ANCVEC) , is the 
angular velocitv vector expressed in the chase vehicle*s body 
coordinate system, 

L, represented In the programs by elements 7 through 9 of STATE, 

is the angular momentum vector of the chase vehicle, expressed 
in the "truth" coordinate system, 

/y , represented In the program by the 3x3 matrix TACV, is the di- 

rection cosine matrix that defines the current chase vehicle 
attitude with respect to the "truth" coordinate system. 

In these simulations the IMU returns exact values for attitude and an- 
gular momentum. Although it would be easy to add corruptions to these 
quantities, this has not been done because the inertial measurement 
unit of a real spacecraft can be very accurate for the few minutes a 
rendezvous operation requires, and IMU errors will not be a major 
contributor tc the total error. 


1). GOAL-SETTING LOGIC PROVIDES INTELLIGENCE 


The goal-setting logic Is a software module in the flight computer and 
is responsible for planning, safety, and hazard recognition. For exam 
pie, it examines the state estimate and covariance matrix provided by 
the mathematical dynamics model, decides how close it should come to 
the target, and where its aim point should be with respect to the cur- 
rent position. The simulations use a minimal version of this software 
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a practical flight system might also decide what trajectory will mini- 
mize fuel use, determine if the target is tumbling so fast that docking 
is impossible, or decide to ask for human assistance via telemetry. 

The subroutine that embodies the goal-setting logic is SETGOL. The 
three simulation programs use slightly different versions of this rou- 
tine because the locations of lights and cameras differ among the simu- 
lations. The essential logic, however, is identical. 

First, the subroutine picks a desired location for the docking fixture 
of the chase vehicle. This point (Fig. VIII-2) will be just beyond the 
end of the target spacecraft's docking fixture. It can be expressed in 
target coordinates as £ = - ^) , where hjj^ is the location of 

the end of the target docking fixture with respect to the target's cen- 
ter of mass and d = (d, 0, 0)^ is a safety margin. 



T 

Multiplicatione by and Are Done to Convert All Vectors 


to the Chase Vehicle's Current Body Coordinate System. Attitude 
Control^ a Separate Operation^ Keeps Pointed Toward the 

Target So Thatj by the Time the Chase Vehicle Reaches Its Goal 
the Attitude Is Correct* 


The value of d is computed from the state estimate covariance matrix 
(P) and has a value of approximately three times the standard deviation 
of the position estimate. If the chase vehicle is estimated to be more 
than 15 meters from the target's x axis, d is Increased to encourage an 
approach along the x axis. 

When range and velocity are sufficiently small, d is set to zero. If 
this were not done, the chase vehicle might hover indefinitely a few 
centimeters from contact. 
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After £ has been determined, the subroutine finds a goal for the chase 
vehicle’s center of mass, expressed In chase vehicle coordinates, with 
the f ormula 


V = A (A^(r - It, )-x) (VII [-10) 

— c t ^ — 

whe re 

represented in the programs as V3, is the goal for the chase 
vehicle’s center of mass, 

, represented in the programs as ACV, is the chase vehicle’s at- 

titude direction cosine matrix, as measured by the inertial 
measurement unit, 

Aj. , represented in the programs as TRNAT, is the transpose of the 

target’s attitude direction cosine matrix, which is derived 
from the appearance of the target in the television Images, 

£, represented in the programs as the first three elements of 

ESTATE, is the chase vehicle’s estimated position in the “pri- 
mary" reference frame, 

hj^c> represented in the programs as HDC, is the location of the 

chase vehicle’s docking fixture with respect to the chase vehi- 
cle’s center of mass. 

Filially, the subroutine defies a "box" or region of space around the 
goal. The control law will use this box in selecting thrusters. If 
the chase vehicle is already within tho box, the control law will at- 
tempt to prevent it from leaving. If it is not within the box, the 
control law will attempt to force it to enter the box before a deadline 
time has been reached. If the chase venicle is within the box and is 
not in danger of immediately drifting out of the box, the control law 
will not activate any thrusters. 

The box concept has two advantages. First, it allows the control law 
to work on a single axis at a time and to ignore any Interaction. Sec- 
ond, it allows control tolerances to be adjusted as a function of the 
distance to the target. This prevents waste of fuel at greater dis- 
tances from the target where accurate positioning is not important. 

The subroutines Implement only a very simple version of the box-sizing 
strategy. 


THE CONTROL LAW DETERMINES IDEAL THRUST VECTORS 


The control law, subroutine CNTLAW, converts the velocity estimate 
(elements A through 6 of ESTATE) to the chase vehicle body coordinates 
and then calls on the function ACCEL six times, once for each transla- 
tional and rotational axis. ACCEL returns a value of zero or +1.0 
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to indicate the state of an idealized thruster (off, on with positive 
thrust, or on with negative thrust)* The value is selected to ensure 
that limit cycling along the axis the thruster controls is confined to 
the "box" defined by the goal-setting logic. The algorithm behind 
ACCEL is difficult to state in plain English, but the "pseudocode" 
flowchart in Figure VIII-3 shows the essential logic. For a given set 
of input parameters, ACCEL defines a simple phase-plane control law. 

The input parameters have the effect of adjusting the phase-plane deci- 
sion boundaries to accommodate different thrust authorities, decision 
intervals, limit cycle envelopes and control bandwidths. 



Tne Logic of the Subi^utine ia Complicated Slightly by the Fact That 
The Thibet Directions Required to Implement "Brakes " 

"Accelerate t " and "Thmat Touard Goal” Depend on the Cux'rent 
Position and Velocity. 
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After £ has been determined, the subroutine finds a goal for the chase 
vehicle’s center of mass, expressed in chase vehicle coordinates, with 
the formula 


V » A (A^(r • h^ )-x) (VII [-10) 

— c t Hac — , 

\ 

represented in the programs as V3, is the goal for the chase 
vehicle’s center of mass, 

I 

represented in the programs as ACV, is the chase vehicle’s at- i 

titude direction cosine matrix, as measured by the inertial 
measurement unit, 

represented in the programs as TRNAT, is the transpose of the 
target’s attitude direction cosine matrix, which is derived 
from the appearance of the target in the television images, 

represented in the programs as the first three elements of 
ESTATE, is the chase vehicle’s estimated position in the ’’pri- 
mary" reference frame, 

represented in the programs as HOC, is the location of the 
chase vehicle’s docking fixture with respect to the chase vehi- 
cle’s center of mass. 

Finally, the subroutine defies a "box" or region of space around the 
goal. The control law will use this box in selecting thrusters. If 
the chase vehicle is already within the box, the control law will at- 
tempt to prevent It from leaving. If it is not within the box, the 
control law will attempt to force it to enter the box before a deadline 
time has beer reached. If the chase vehicle is within the box and is 
not in danger of immediately drifting out of the box, the control law 
will not activate any thrusters. 

The box concept has two advantages. First, it allows the control law 
to work on a single axis at a time and to Ignore any Interaction. Sec- 
ond, it allows control tolerances to be adjusted as a function of the 
distance to the target. This prevents waste of fuel at greater dis- 
tances from the target where accurate positioning is not important. 

The subroutines implement only a very simple version of the box-sizing 
strategy. 


where 

V, 

Ac. 

At. 

21 ’ 

l2dc» 


E. THE CONTROL LAW DETERMINES IDEAL THRUST VECTORS 


The control law, subroutine CNTLAW, converts the velocity estimate 
(elements 4 through 6 of ESTATE) to the chase vehicle body coordinates 
and then calls on the function ACCEL six times, once for each transla- 
tional and rotational axis. ACCEL returns a value of zero or +1.0 
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to indicate the state of an idealized thruster (off, on with positive 
thrust, or on with negative thrust). The value is selected to ensure 
that limit cycling along the axis the thruster controls is confined to 
the "box” defined by the goal-setting logic. The algorithm behind 
ACCEL is difficult to state in plain English, but the pseudocode 
flowchart in Figure VIII-3 shows the essential logic. For a given set 
of input parameters, ACCEL defines a simple phase-plane control law. 
The input parameters have the effect of adjusting the phase-plane dec! 
Sion boundaries to accommodate different thrust authorities, decision 
intervals, limit cycle envelopes and control bandwidths. 



The Logic of the Subroutine is Con^lioated Slightly by the Foot That 

The Thruet Directions Required to Inclement "Brake," 

"Accelerate," and "Thrust Toward Goal" Depend on the Current 
Position and Velocity, 
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THRUSTERS APPROXIMATE REQUIRED FORCES AND TORQUES 


A practical spacecraft has a limited number of thrusters and cannot 
command an arbitrary acceleration i^' an arbitrary direction. The simu- 
lation models this restriction by giving the chase vehicle only 14 
thrusters* (Physically there are 15, but two of them are controlled as 
a unit.^ Combinations of the 14 thrusters can be selected to provide 
accelerations in any combination of the three translational axes and 
torques about any combination of these axes. The magnitudes of the 
accelerations and torques may, however, significantly differ from the 
ideal values. The logic in the control law accounts for this fact by 
knowing both the maximum and the minimum possible value for each accel- 
eration and torque. 

There are three possible commands (-1, 0, and +1) for each axis, and 
there are six axes for which commands can be given (x, y, z, yaw, roll, 
and pitch). This means there are only 3^ or 729 different command 
combinations that can be given. Subroutine SELECT converts the set of 
commands to an index and then looks up an appropriate set of thrusters 
in a table. In flight hardware this could be done by using read-only 
memory to convert acceleration commands to thruster commands. 


CfiASE VEHICLE DYNAMICS RESPOND TO THRUSTER COMMANDS 

The simulation programs use a set of five coupled differential equa- 
tions to compute the chase vehicle's response to the thrusters. These 
equations propagate the vehicle's so-called ’‘true state”, which in- 
cludes position, velocity, angular momentum, attitude, and mass. Be- 
cause some of these quantities are vectors, the number of elements in 
the state is 14. These quantities are represented in the programs by 
the array STATE, whose elements are defined in Table VIII-2. 

The array STATE differs significantly from the array ESTATE, the state 
estimate used for navigation. ESTATE contains only position and veloc- 
ity estimates and therefore has only six elements. These six elements 
are not simply estimates of the first six elements of STATE because two 
different coordinate systems are used. 

The true state is measured with espect to a nonrotating coordinate 
system centered at the target spacecraft's center of mass. The orien- 
tation of this coordinate system Is fixed at the instant the simulation 
begins, with the +z axis pointing away from the center of the earth, 
the +y axis aligned with the orbit angular moment jm vector, and the ^ 
axis defined by the cross product of unit vectors along the +y and +z 
axes. This orientation was chos?n to simplify the c^Ic*alatlon of grav- 
ity gradient acce lerat I otis. 
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Table Vlll-2 

Definitions of Elements of True-State Array STATE 


Element Number 

Definition 

1 

X Position (m) 

2 

Y Position 

3 

Z Position (ni) 

4 

X Velocity (m/s) 

5 

Y Velocity (ra/s) 

6 

Z Velocity (m/s) 

7 

Angular Momentum about X Axis (kg m^/s) 

8 

Angular Momentum about Y Axis (kg m^/s) 

9 

Angular Momentum about Z Axis (kg m^/s) 

10 

qi of Attitude Quaternion 

11 

q 2 of Attitude Quaternion 

12 

q 3 of Attitude Quaternion 

13 

q^ of Attitude Quaternion 

14 

mass (kg) 


The state estimate (ESTATE) uses a different coordinate system to dem- 
onstrate tiiat the guidance system has no need for the target-orbit 
information that defines the truth coordinate system. In a flight sit- 
uation the guidance system may^ in fact, have no access to this 
info matlon. 

The differential equations, summarized in Table VIII-3, are integrated 
in subroutine PROPTi with fourth-order Runge-Kutta numerical integra- 
tion. This integral i.on algorithm calculates the state at a future time 
from the current state and the first derivative of the state at various 
points within the integration interval. Since a minimum of four evalu- 
ations of the first derivative are used for any interval, a separate 
subroutine, STPRIM, is used to calculate the derivatives* This subrou- 
tine, in turn, calls subroutines that evaluate the equations in Table 
VIIl-3. Table VIII-A shows the meanings of the symbols In the formulas 
and the names of the variables used In the simulation program to repre- 
sent them. 

The orbit is modeled as a 300-Wi lometer circular earth orbit. Because 
of the choice of coordinate system, the orbit has only a minor second- 
order effect; it determines the magnitude and direction of the gravity 
gradient acceleration, which is a relative acceleration between the tw 
spacecraft caused by the fact that gravity acts most strongly on the 
spacecraft closest to the earth. The maximum magnitude of this differ- 
ential acceleration is approximately O.OOOl g. 
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Table VIII-3 Major Equatione for True-State Computation 




Subroutine Where 
Computed 


(VIII-11) 1 FORCE 


(Vm-12) MPRIME 


V ■ a + i/m 
- -8g - 


- l”^AL 



(VIII-13) LINACL 


(Vm-14) ANGVEC 


(VIII-15) MAKROT 


N - A »' F 


(VI I 1-16) I TORQUE 


L - N - (A w. ) X L 
— — —0 


(VlII-17) LPRIME 


^- 0 . 5 ^ 3 ^ 


(VIII-18) QPRIME 


X ■ V 


(VllI-19) STPRIM 
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Table VIII-4 Definition of Variables in Table VIII~3 


Algebraic 

Symbol 

1 

Dimension 



Program 

Variables 

— 

— 

Units 

Coordinate 

System 

Meaning 

T 

A,A 

3x3 

A, TRNA 

— 

— 

Truth 

Direction Cosine Matrix 
Corresponding to q 

1 

3x1 

NTFORC 

N 

Truth 

Net Force Vector from 
Thrusters 

F 

14 X 1 

F 

N 

— 

Element i is the 
Magnitude of Thrust 
Produced by Thruster i 

i, 

3x3 

INERTA, 

INVIN 

. 2 
kg*m , 

1, -1 -2 
kg 'm 



Body 

Moment of Inertia and 
Its Inverse 

dl/dm 

3x3 

FULDIS 

2 

m 

Body 

Sensitivity of I to 
Additional Fuel Mass 

r- 1 

1 X 14 

1 

1 

AKl 

kg*N s 


Element i is Fuel Mass 
Consumed 1 per Newton- 
Second of Thrust, for 
Thruster i 

h 

I 

3 X 14 

AK2 

1 

i 

i 

Body 

! 

Column i is a Unit 
Vector in the Direction 
of the Thrust Produced 
by Thruster i 

s 

3 X 14 

AK3 

m 

Body 

Column i is a Vector 
Corresponding to 
Thruster i. Its 
Direction is the 
Direction of the Torque 
Produced by the Thruster. 
Its Magnitude is the 
Amount of Torque per 
Newton of Force. 

L, L 

h' 

3x1 

S1ATE(7) 
(et seq.), 

ESTATE (7) 
(et seq.) 
DLDT 

kg*m^/s, 

T, 2,2 

kg*m /s 

Truth 

1 

Angular Momentum about 
Center of Mass and its 
Rate of Change 
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Table VIII-4 (oonal) 


Algebraic 

Symbol 

Dimension 

Program 

Variables 

Units 

Coordinate 

System 

Meaning 

m , m 

Scalar 

STATE (14), 
DS TATE (14) 
or DMDT 

Itg. 

kg/s 

— 

Total Chase Vehicle 
Mass and Its Rate of 
Change 

N 

3x1 

N 

N*m 

Truth 

Torque about Center of 
Mass 


4x1 

STATE (10) 
(et seq), 
DSTATE(IO) 
(et seq) 
or QPRM 

> 

-1 

s 

Truth 

Allitude Quaternion 
and its Rate of 
Change 


3x1 

STATE (4) 
(et seqK 
DSTATE(4) 
(et seq) 
or ACCEL 

m/s, 

m/s^ 

Truth 

Velocity and Its Rate 
of Change 


3x1 

STATE (1) 
(et seq), 
DSTATE(l) 
(et seq) 

m, 

m/s 

Truth 

Position and Its Rate 
of Change 

% 

3x1 

BODVEL 

-1 

s 

Body 

Angular Velocity 

1 

i— 

A 

OMEGA 

-1 

s 

Body 

Matrix Formed from 
Eleiaents of to 

Implement Equation 
(D-6) 


H. Ti\RGET ATTITUDE IS MODELED AS DETERMINISTIC 


Subroutine TRGATT computes the target spacecraft's attitude as a func- 
tion of time. In the simulations several versions of this subroutine 
were used to simulate different initial attitudes and tumbling at dif- 
ferent rates about different axes. In each case a simple tumbling was 
assumed so that system performa Te could be evaluated as a function of 
simple parameters. 
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DIFFERENT SPACECRAFT CAN BE MODELED 


The dynamics model used in these programs is readily adapted to differ- 
ent targets and chase vehicles. For example, different masses, thrust- 
er orientations, number of thrusters, thruster forces, docking fixture 
locations, camera locations, fuel loads, and engine types can be mod- 
eled without changing the program logic. Different control laws can be 
used by changing the logic of subroutine CNTLAW, and different methods 
for deriving rates can be investigated by replacing the Kalman filter 
subroutines. These investigations were beyond the scope of the study 
reported here. 
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IX. COMPUTER MODELS OF MEASUREMENTS AND NOISE 


A. LIGHT POSITIONS ARE MODELED WITH PERSPECTIVE PROJECTION 


In each program, lights are assumed to be point light sources, and the 
inages from the cameras are simulated by perspective projection. The 
calculations are identical for each light in every program, except that 
the vectors defining camera and lamp positions vary in value. The bas- 
ic strategy is to compute the position of the lamp in the chase, vehi- 
cle’s camera coordinate system. This system is parallel to the chase 
vehicle’s body coordinate system but offset by which is the sepa- 

ration between the camera and the chase vehicle’s center of mass. The 
formula for determining a lamp’s position in the camera coordinate sys- 
tem is 


L - \ "L: 

The physical interpretation of this formula is shown in Figure IX-1. 



The position of the lamp’s image on the television screen can be deter- 
mined from 

u - -r 2 f/rj (IX-2) 


IX-1 


for the horizontal component and from 




(lX-3) 


for the vertical component, where ix, r 2 , and r 3 are the x, y, 
and z components of _r. The direction cosine matrix is derived 
from the true state, which is represented in the programs as the array 
STATE. Elements 10 through 13 of this array are the attitude quater- 
nion. It is converted to a direction cosine matrix with equation (D-5) 
from Appendix D. The vector ^ is the current position of the chase 
vehicle’s center of mass with respect to the *'truth” coordinate system 
defined in Chapter VIII. This vector is the first three elements of 
the array STATE. The vectors and 1^, which vary from one simu- 
lation to the next, are the positions of the camera and lamp, respec- 
tively: hj^ is the camera position with respect to the c\ jse vehi- 

cle’s center of mass, and ^ is the docking aid’s position with 
respect to the target spacecraft’s center of mass. The direction 
cosine matrix A^ is the target’s attitude, which is computed as a 
function of time in subroutine trgaTT, as described in Chapter VIII. 


This measurement model’s accuracy depends on the validity of several 

assumptions: 

1) The focal plane of the camera is flat and parallel to the y-z plane 
of the chase vehicle’s coordinate system; 

2) The lens and the scanning of the camera do not significantly dis- 
tort the image; 

3) The lamp’s image is small enough to be considered a pclnt; 

4) The lamp is bright enough to be considered the only sign! :icant 
object in the image. 


Equations (IX-1) through (IX-3) are used several times in each simula- 
tion. In the program that simulates the system with three flashing 
lights, for example, the equations are used three times per observation 
with different values of hi* Similarly, in the program that simu- 
lates the system with stereo ranging, the equations are used three 
times with different values of h^. 


B. RANDOM NOISE CORRUPTS IMAGE COORDINATES 


To simulate the imperfections of a practical guidance system, the simu- 
lation programs add random numbers to the coordinates computed by equa- 
tions (IX-2) and (IX-3). The random numb*'rs have a Gaussian distribu- 
tion with a mean of zero and a standard deviation selected to represent 
the root-mean-square uncertainty in the ideal locations of the lamp 
images. 


IX-2 


This uncertainty arises from several factors: 

1) Imperfect electronics are used to compute the center of brightness 
of the image* The operational amplifiers, analog multipliers, and 
other components corrupt the video and deflection signals with 
biases and random errors; 

2) Scanning is not perfect. In some cameras a sawtooth analog deflec- 
tion voltage or current is used for scanning. Misalignment of de- 
flection coils, imperfections in deflection drive amplifiers and 
similar factors may cause errors in the center-of-brightness cal- 
culations. Some cameras use discrete picture elements, which may 
cause the center of brightness to shift due to quantization er- 
rors. Finally, solid-state cameras use no analog deflection volt- 
age, and the use of a synthetic deflection voltage in the center of 
brightness computation may introduce errors caused by errors in 
deflection amplitude and synchronization with the actual scanning 
of the camera; 

3) Lenses introduce errors. The distortions, aberrations, and focus- 
ing limitations of practical lenses can add additional corruptions 
to the center of brightness calculations; 

4) Camera positioning is not perfect. The mathematical model of equa- 
tion (lX-1) does not allow for misalignment of the camera axes from 
the spacecraft axes, errors in the camera^s mounting location, or 
the transient changes in position and alignment caused by thermal 
expansion and vibration; 

5) Camera sensitivity varies from picture element to picture element. 
In some solid-state cameras the variation is as much as 15 per- 
cent. Further, some solid-stace cameras have blemishes — picture 
elements that always give full output or no output no matter how 
much light shines on them. Charge-coupled device (CCD) cameras 
tend to "bleed" from one scanning line to the next when a bright 
light is in the field of view, while other Ccuneras are troubled 
with blooming and after-images. Many cameras have significant 
"dark" output that varies from picture element to picture element 
and may vary greatly with temperature. 

Meaningful numbers cannot be assigned to all t5 '^se error sources, es- 
pecially because there are no detailed designs tor the spacecraft, 
guidance system, and mission. The noise model should therefore be con- 
sidered a specification of the maximum allowable signal corruption 
rather than a prediction of system perforra»'ce with fome specified set 
of hardware. 
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APPENDIX A“COMPUTER PROGRAM TO SIMULATE THREE-LIGHT SYSTEM 


The program listing in this appendix is provided to document the simu- 
lation methods used in analyzing the three-light video guidance sys- 
tem. It T.’as written to run on a Prime 550 computer under the PRIMOS 
operating system, but it has few hardware-dependent subroutines. If it 
is to be run on another computer, the following information will prove 
useful : 


1) Several library routines are used, and these are not shown in the 
listing. The routines include ACOS and ASIM, which compute the 
inverse trigonmetrlc functions cos”^x and sln“^x, and a random 
number generator, RANFN. The latter function computes normally 
distributed random values with a specified mean and standard devia- 
tion. In addition, the matrix arithmetic routines MADD (addition), 
MSUB (subtraction), MMLT (multiplication), MINV (inversion), MSCL 
(multiplication by a scalar), MIDN (setting an array to the iden- 
tity matrix), and MTRN (forming the transpose of a matrix) are used 
from the Prime library MATHLB; 


2) File handling may present conversion problems even if the program 
is to be run on another Prime 550 computer because logical unit 
numbers, file names, and amount cf disk storage vary f^*om installa- 
tion to installation. Standard Prime subroutines are used to open 
and close files. These subroutines (TSRC$$, EXST$A, CL0S$A, 

DELE$A) are from the Prime library APPLIB; 

3) Run time is approximately real time if the computer is dedicated to 
a single user. That is, a simulation of three minutes of flight 
will take approximately three minutes; 

4) Tlie perspective drawings shown in this report are not created di- 
rectly by this program. They are drawn by a second program that 
uses the data file created by this program. This allows the crea- 
tion of stereo plots and views from different perspectives; 

5) Several WRITE statements in subroutine DOCK are rendered inactive 
by a character C in the first column of the text. Removing this 
character will provide a printout at the user's terminal for moni- 
toring the progress of a simulation, but this will make the simula- 
tion run more slowly; 

6) The goal in writing the program was to make the program easy to 
modify. As a result, many of the operations are done inefficient- 
ly, and a speed Improvement by a factor of two or three might be 
achieved . 


The first part of the listing is the text of a terminal session, which 
includes compilation, loading, and execution of the program* 
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Appendix B 
Computer Program to 
Simulate System That Uses 
“Rainbow” Beacon and 
Rangefinder 


APPENDIX B--COMPUTER PROGRAM TO SIMULATE SYSTEM THAT USES "RAINBOW” 
BEACON AND RANGEFINDER 


Tlie program listing in this appendix is provided tu document the simu- 
lation methods used in analyzing the "rainbow" beacon video guidance 
system. The discussion presented in Appendix A is equally applicable 
to this progratt-. The text of the terminal session, which is presented 
in Ajipondlx A, is not repeated here because the user commands and dia- 
log are essentially Identical i-o those in Appendix A. 
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FUNCTION DPRDIX, Y, IDIM) 

(* 907 - COMPUTE THE DOT PRODUCT OF TWO VECTORS *) 

CALLS. 

<NONE> 

CALLED BY; 

QUATRN 

INPUTS; 

X, Y, IDIM 

outp«;ts; 

DPRD 

REAL ?PRD 

(* DOT PRODUCT OF VECTORS X AND Y #) 

REAL X<3). Y(3) 

(* VECTORS FOR WHICH DOT PRODUCT IS TO BE DETERMINED *) 

INTEGER IDIM. I 

(* DIMENSION OF VECTORS X AND Y. AND DO LOOP INDEX. RESPECTIVELY *) 
REAL SUM 

(* INTERMEDIATE RESULT WITH NO SIMPLE INTERPRETATION *) 

<* COMPUTE DOT PRODUCT «) 

SUM«0. O 

DO 10 1*1. IDIM 

SUM*SUM+X( I )*Y( I ) 

10 CONTINUE 
DPRD»SUM 
RETURN 

END 
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Appendix C 
Computer Program to 
Simulate System That Uses 
Ring of Lights 



ArPENDIX C—COMPUTER PROGRAM TO SIMULATE SYSTEM THAT USES RING OF LIGHTS 


The program llsring in this appendix is provided to document the simu- 
lation methods used in analyzing the "ring-of-light s’* video guidance 
system. The dibcussion presented in Appendix A is equally applicable 
to tills program. The text of the terminal session, which is presented 
In Appendix A, is not repeated here because the user commands and dia- 
log are essentially identical to chose in Appendix A. 
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TRUE STATE 


STATE < 1) 

X POSITION 


STATE < 2) 

Y POSITION 


STATE < 3) 

Z POSITION 


STATE ( 4) 

X VELOCITY 


STATE ( 3) 

Y VELOCITY 


STATE ( 6) 

Z VELOCITY 


STATE < 7) 

ANGULAR MOMENTUM ABOUT 

X 

STATE < 8) 

ANGULAR MOMENTUM ABOUT 

Y 

STATE < 9) 

ANGULAR MOMENTUM ABOUT 

Z 

STATE (10) 

Q1 \ 


STATEdl) 

02 \ 


STATE < 12) 

03 > ATTITUDE W. R. T. 

'TRUTH' 

STATE<13) 

04 / 


ST ATE (14) 

MASS. INCL FUEL 


(X. Y. Z) 

® 'TRUTH' AXES 


STATE ESTIMATE 


ESTATE(l) 

X' POSITION 


ESTATE(2) 

Y' POSITION 


ESTATE(3) 

Z' POSITION 


ESTATE(4) 

X' VELOCITY 


ESTATE O) 

Y' VELOCITY 


ESTATE (A) 

Z' VELOCITY 



<X',Y'.Z') » 'PRIMARY REF. FRAME' AXES 
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Appendix D 

Attitude Parameterization 



APPENDIX D— ATTITUDE PARAMETERIZATION 


The three computer simulations performed in this study required fre- 
quent conversions among coordinate systems. For example, the camera 
locations are fixed in the chase vehicle's body coordinate system, but 
this system is constantly rotating with respect to the inertial frame 
used for navigation. Similarly, the docking aid’s position is fixed in 
the target spacecraft’s coordinate system, which also rotates with 
respect to the inertial frame. After each observation, the onboard 
computer must compute the position of the chase vehicle’s center of 
mass with respect to the target’s center of mass. Because the camera 
and the docking aid are not at the target’s center of mass, the comput- 
er must convert all the position data to a consistent coordinate system. 

One of the most convenient ways to convert a vector from one coordinate 
system to another is to multiply the vector by the direction cosine 
matrix that expresses the relationship between the two coordinate 
systems. 

Because the target’s direction cosine matrix is not known in advance, 
it must be measured. The calculations required to do this are simpli- 
fied somewha^ if quaternions are used as an intermediate step. Quater- 
nions were also found useful for a number of other operations in the 
simulation programs. 

Direction cosine matrices and quaternions are alternative ways to ex- 
press exactly the same information, and the computations to convert 
from one to the other are not difficult. Subroutine DIRMAT in the com- 
puter programs in Appendices A through C converts from quaternion nota- 
tion to direction cosine matrix notation. Subroutine TOQUAT in Appen- 
dix C converts from direction cosine matrix notation to quaternion 
notation. 

Suppose that A is a 3x3 direction cosine matrix that expresses the at- 
titude of a rotated coordinate system with respect to a fixed system, 
and that ^ and ^ are 3x1 matrices that express the vector ^ in 
the rotated and fixed frames, respectively. Then and are 

related by the equations 


V ■ A V- , 
— r — f 

(D-1) 

■ A V . 

— f -r 

(D-2) 


The second equation makes use of the fact that direction cosine ma- 
trices are members of a special class of matrices whose inverses are 
equal to their transposes. The superscript T can therefore be thought 
of as denoting eit’ er the inverse or the transpose in this context. 
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The rows and columns of a direction cosine matrix have a simple physi- 
cal interpretation: the columns are the unit vectors that define the 

fixed coordinate systan, expressed in the rotated coordinate system. 
Similarly, the rows are the unit vectors defining the rotated coordin- 
ate system, expressed in the fixed coordinate system. 

For example, if the fixed coordinate system is defined by the vectors 
£, j_, and ]c, and the rotated system's unit vectors are £, and w, and 
if A = [a^s]» 1 . can be expressed in the fixed system as ( 1 , 0 , 0 )"^ 
or in the rotated system as a2i, Likewise, £ can 

be expressed in the rotated frame as (1, 0, 0)^ or in the fixed frame 
as (aj[x, 3i2» ^13)^* 

There is a simple formula for computing the direction cosine matrix 
that represents the results of two successive rotations. If A£i rep- 
resents the attitude of coordinate system 2 with respect to system 1, 
and A32 represents the attitude of coordinate ystem 3 with respect 
to syston 2 , then A31, wh^ch gives the attitude of system 3 with re- 
spect to system 1, can be computed from the formula 

A31 “ A32A21 . (D- 3 ) 


Quaternions are based on an entirely different view of attitude. There 
is a theorem that states that no catter how a rotated frame is oriented 
with respect to a fixed refer:-nce frame, the orientation can be ac- 
counted for by assuming a single rotation about a single axis. The 
angle of rotation is called the Euler angle (^), and the axis is 
called the Euler axis (£) . The quaternion representing the attitude of 
the rotated frame is a 4 x 1 matrix* 



sin ($/2) 


■'ll' 

1 “ 

sin (*/2) 

= 

‘*2 


sin (*/2) 



where 

cos (i/ 2 ) 

®1* ®2» ® 

3 

.‘‘a 

thet 


(D- 4 ) 


are the components of the Euler axis in the 
fixed coordinate system. 


The direction cosine matrix can be expressed in terras of the quaternion 
elements as 


A - 


- q| + qg 
2(qiq2 - qaq 4 ) 
2(qiq3 + q2qi+) 


2 (qiq2 + q 3 <i 4 ) 

-q? + q? - q§ + q? 
2(q2qs “ qiq4) 


2(qiq3 - q2q4> 
2(q2q3 + qiq4) 


(D- 5 ) 


-q? “ q§ + qf + q^ 


and subroutine DIRMAT is a straightforward implementation of this form- 
ula. The reverse operation can be performed by aiy of four equivalent 
sets of simple formulas, but an appropriate set must be used to avoid 
subtraction of nearly equal quantities or division by zero. Subroutine 
TOQUAT contains all four sets of formulas and the logic required to 
select an appropriate set. 


*In mathematics texts where quaternions are viewed as hypercomplex num- 
bers, the elements are usually shown in n dirrctcuL 
given here is used consistently throughout this report. 
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Quaternions are useful when orientation is known (or sought) in terms 
of the Euler angle and axis. They also prove especially useful in nu- 
merical integration of angular velocity because there is a simple form- 
ula for the integration and because they are easy to renormalize. 

Renormalization is required because roundoff and other errors in numer- 
ical integration cause the norm of the quaternion to drift. [The norm 
is the square root of the sum of the squares ot the four elements, and 
must be exactly 1.0 for the definition in equation (D-4) to be valid.] 
Renormalization is a simple matter of dividing each element of the 
quaternion by the norm. 

Numerical integration with direction cosine matrices requires only 
about 30 percent more additions and multiplications, but normalization 
is much more difficult. If a direction cosine matrix is not normal- 
ized, after several integration steps it begins to represent a mapping 
into a distorted coordinate system and not a simple rotation. This hap- 
pens because roundoff errors leave rows and columns representing vec- 
tors that are not of unit length or vectors that do not define the axes 
of a rectangular coordinate system. 


The formula used in the simulations for integrating angular velocity is 


d^/dt « 


(D- 6 ) 


where: 

To 


CO 


w 



a 


-u) 0 

w 


U) 


u 


U) 


v 


UJ -CO 0 CO 

v u w 


(D-7) 


L -CO -0) -CO 0 I 

u v w J 

a matrix made up of angular velocity components about the spacecraft 
body axes, 'fhe integration starts with an initial value for £ and uses 
equation (D-4) to calculate q at future times. 


A quaternion version of equation (D-3) can be used to combine the ef- 
fects of multiple rotations. If ^21 represents the attitude of coor- 
dinate system 2 with respect to system 1 , and qj2 represents the at- 
titude of coordinate system 3 with respect to c»ystem 2, then 3 ^ 31 , 
which gives the attitude of system 3 with respect to system 1 , can be 
computed from the formula 


S.31 ” Q 


(D- 8 ) 


where Q is a 4x4 matrix formed from the elements of £^32 


^4 

qa 

-qz 

qi 

-qa 

qu 

qi 

qz 

q2 

-qi 

q4 - 

qa 

-qi 

-qz 

-qa 

q4 
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In which 


132 


^2 

qa 


Lq 4 j 

An alternate formula that gives identical results Is 


(D-10) 


131 - Q' a.32 


(D-11) 


in which Q’ is a 4xA matrix formed from the elements of 


q<*' 

-qa' 

q2* 

qi' 

q3* 

q4* 

-qi’ 

q2’ 

1 

>0 

ro 

qi' 

q**’ 

q3* 


L-qi* -q2* -q3* q4* 

where 

r..-i 


l21 


q2* 

qa' 


(D-12) 


(D-13) 


b.'J 

Equations (D-8) and (D-11) can be considered definitions of quaternion 
’multiplication*" The multiplication defined is (^21 5L32)» which 
does not equal (^2 i21^* Quaternion multiplication has an iden- 
tity quaternion (0 0 0 1)^ that is analo,^ous to the Identity matrix 
in matrix arithmetic* The product of this quaternion with any quater- 
nion ^ is whether ^ is on the left or on the right in the multloli- 
cation. Also, any quaternion has an Inverse The product qq^^ 

* equals the identity quaternion* The inverse is formed by 

simply negating the first three elements of the quaternion* 
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/\PPENDIX E^-^ADAPTING THE KALMAN FILTER FOR OTHER SIMULATIONS 


ThG Kalman filter used in the three simulations presented in this 
report can be adapted for other rendezvous and docking simulations if 
Che appropriate changes are made. 

The Kalman filter accepts a 3-element measurement vector representing 
the measured position of the chase vehicle’s center of mass in the 
primary reference frame. (The primary reference frame is a nonrotating 
right-handed rectangular coordinate system that is centered at the tar- 
get spacecraft’s center of mass but aligned with the body axes of the 
chase vehicle the instant the video guidance system takes control.) 

The measurement data in the simulation programs are obtained from video 
information. The Kalman filter can be used for simulations that use 
any ot-.er sensor and target that produces X, Y, and Z position data> 
provided that the necessary changes are made. Subroutine ESTCOV, which 
estimates the measurement covariance, must be altered so the measure- 
ment cc ariance matrix is reasonable for the accuracy of the sensor and 
target used. There are two convenient methods of deriving the measure- 
ment covariance matrix. It can be calculated by fitting a curve to 
data from a Monte Carlo si -^ulation or it can be derived from an analyt- 
ical determination of the sensor’s accuracy. The simulation programs 
in this report used curve-fitting and a Monte Carlo simulation to de- 
termine the equation for VARNCE, the estimated variance per axis. The 
estimated measurement covariance matrix R is then assigned to be a di- 
agonal matrix whose elements along the diagonal are equal to VARNCE. 

It is important to realize that system performance Is the issue — as 
long as the Kalman filter performs well, an accurate measurement covar- 
iance estimate is not necessary. 

If a different chase vehicle is desired for other simulations, a thor- 
ough reevaluation of the Kalman filter equations is recommended. The 
dynamics equations and the assumptions made tc implement the Kalman 
filter could be totallv wrong for another chase vehicle, and overlook- 
ing these differences could cause unsatisfactory system performance. 

The numerical scheme that propagates the state estimate and the state 
covariance matrix between measurements is valid only for small time 
intervals between measurements. If intervals between measurements of 
about 1 second or greater are desired, a more accurate integration 
technique must be used. To use an alternative integration scheme, sub* 
routine PROPES must be changed to implement .-he new integration 
technique. 

Other design changes not mentioned here require a thorough reevaluation 
of the Kalman filter equations. 


E-1 


